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Abstract 

The primary focus in geometric modeling and computer-aided design has been on 
the analysis of individual components. However in practical engineering applications, there 
is often the need to examine the performance of an assembly of components rather than the 
individual components. A very welcome development would be the introduction of a software 
package which would allow a designer to create individual components, assemble them and 
then perform the necessary analysis on them. 

Conventionally, if the designer wants to inspect the dynamic or kinematic performance 
of an assembly, he has to generate a model of the assembly for the analysis from the assembly 
drawings. Also, he has to regenerate the model whenever any component is modified. This 
additional step tends to lead the designer to either consider fewer design alternatives or to 
skip the analysis. 

This work provides a simple and user friendly assembly modeling system for all me- 
chanical parts. This is achieved using two approaches, one is Homogeneous Transformation 
Matrix approach and the other is Mating Conditions approach. These two approaches were 
successfully tested for performing different mechanical assemblies with different mating con- 
ditions. Although both the approaches require the user to input the necessary geometric 
information, each of them has its own advantages and limitations. Although there are many 
assembly sequences possible for the cases we have solved, the most convenient assembly se- 
quence is being used. The assembly sequences used are manual ones. 

In this work, OpenGL (Open Graphics Library) is used for rendering diflferent compo- 
nents of an assembly. The algorithm for assembly procedure has been written in “C” language 
which has good interface with OpenGL. The representation scheme being used is Boundary 
representation (B-rep) as the mating conditions are related to the faces, edges and vertices of 
the assembled parts. 

Although this work is complete up to the assembly modeling stage, one can extend it 
for performing assembly analysis such as interference checking, mass property calculations and 
finite element analysis. There is also a scope for extending this work for generating automatic 
assembly sequences from the mating features of the various components of the assembly. 
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Chapter 1 
Introduction 


The primary focus in geometric modeling and computer-aided design has been on the 
design and analysis of individual components. However in practical engineering applications, 
there is often the need to examine the performance of an assembly of components rather 
than the individual components. A very welcome development would be the introduction of 
a software package which would allow a designer to create individual components, assemble 
them and then perform the necessary analysis on them. 

Conventionally, if the designer wants to inspect the dynamic or kinematic performance 
of an assembly, he has to generate a model of the assembly for the analysis from the assembly 
drawings. Also, he has to regenerate the model whenever any component is modified. This 
additional step tends to lead the designer to either consider fewer design alternatives or to 
skip the analysis. 

The objective of this study, although it is complete only up to the assembly modeling 
stage, is to create an integrated procedure in which the designer can create individual compo- 
nents, assemble them into an assembly and perform the dynamic or kinematic analysis at any 
time during the course of design. With this procedure there would be no extra effort required 
by the designer for the analysis. Thus, the analysis can be performed for all the alternative 
designs. 


1.1 Literature Survey 

An assembly of components can be represented by the description of its individual com- 
ponents in the assembly and the relationship between the components in the assembly. The 
representation schemes of individual components have been well established. In this work, 
Boundary representation (B-rep) is chosen over constructive solid geometry (CSG) represen- 
tation for interactive assignment of mating conditions between components in an assembly. 
However, the assembly data structure to represent the relationship between components has 
not been well established. The inherent problem in most assembly data structures is that they 
lack the ability of interactive assignment in building or developing the assembly. For example 
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in the assembly data structures introduced by Wesley et af , the location and orientation of 
each component in the assembly is specified by a 4 x 4 homogeneous transformation matrix. 
The provision of the transformation matrices for each respective component is done in a non- 
interactive manner. Specifying each transformation matrix for each component can be quite 
awkward and tends to be error prone, and therefore is better to avoid. 



Component Component Component Component Component Component 


Figure 1.1: Tree structure for assembly 

The data structure developed by Lee® (Figure 1.1) overcomes the problem of specifying 
transformation matrices directly by using more basic information between individual compo- 
nents in an assembly through mating conditions. He introduced the concept of a “virtual 
link” to group all the mating conditions between a pair of mating components into one entity 
(virtual link), Thus an assembly of components can be represented in a hierarchical tree. In 
this approach, the top node of the tree is the assembly which is composed of sub-assemblies 
interrelated by the virtual links. Tracing down the sub-assemblies, other sub-assemblies may 
be encountered that are related by virtual links which further branch down to the terminal 
nodes of the tree structure which are the individual components, i.e. if the component is used 
more than once in the assembly then the concept of “instance” may be used. This allows many 
identical components or instances to have only one component data structure and the virtual 
links point to the instances of the component rather than to several identical components. 


2 
















Since Lee® provided the mating feature information, the transformation matrix for 
each component need not be assigned because it may be derived from the mating feature 
information carried by virtual links. An added benefit using mating condition information 
instead of providing the transformation matrices is the determination of whether or not the 
components in an assembly can be assembled, if it turns out that some components can not 
be physically be assembled, the transformation matrices satisfying all the mating conditions 
do not exist and the computation routine for transformation matrices will diverge. In this way 
only possible assembly can be stored in the database. 

In this assembly data structure, the mating conditions are specified instead of the 
transformation matrices, which require the calculation of transformation matrices from the 
given mating conditions. Lee and Andrews^ proposed an approach for deriving the 12 vari- 
ables (nine rotational and three translational elements) of the homogeneous matrix shown 
below by using the spatial relationships defined by the mating conditions. 


Oix Px 

(ly Py 

az Pz 
0 1 

Therefore to assemble N components, N - I transformation matrices need to be 
supplied ( one component is fixed as the reference component). This indicates that 12 x {N — 
1) variables must be solved simultaneously. The against and the fits conditions along with 
the transformation matrix properties provide the constraint equations necessary to solve the 
12 X (A — 1) variables. 

In this method, it turns out that the number of equations is always equal to or greater 
than the number of variables produced. Therefore, a method must be used which accounts for 
the number of redundant equations realized. The authors^ incorporate an algorithm developed 
by Light which searches for groups of equations which exhibit a linear dependency. By identi- 
fying the redundant equations with Light’s Routine, the set of equations can now be reduced 
to a number of equations which equal the number of variables. The linearly independent 
equations can now be solved via the Newton-Raphson iteration method. The authors point 
out that the Newton-Raphson iteration can fail due to the non-uniqueness of the non-linear 
set of equations. They^ have also noted that the initial guess on the transformation matrix 

elements can dictate the success of convergence to a correct solution. 

Since there are more equations than variables, a suggested alternate solution method 
to bypass Light’s routine in searching for redundant equations is the Least Squares Technique. 
Although it was suggested, they^ did not use the least square algorithm. 
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1.2 General Approach 

The general approach used to derive the assembly model and develop the joint infor- 
mation necessary for further analysis is outlined in four steps. 

• Step 1: Represent individual components in a database 

Any existing Boundary representation scheme can be used to represent each component. 

• Step 2: Specify the relationship between the components in an assembly 
This involves the problem of how to represent an assembly, i.e. how to store relationship 
between each component in an assembly. 

• Step 3: Find the location and orientation of their assembled positions 

To accomplish this step, a computational scheme is employed that uses the two ap- 
proaches. 

• Step 4: Perform the dynamic and kinematic analysis on the created assembly 
Though not incorporated in this work, the joint information for this analysis can be 
derived directly from the assembly model. 

1.3 Objective of the Present Work 

It is the common practice that a designer creates the model of a mechanical compo- 
nent on a CAD system and the commands for a numerical controlled system or machine are 
directly generated to manufacture the component. By analogy, it would be very productive 
if an assembly procedure were generated directly as designer creates a model of an assembly 
of components. As mentioned earlier, if the designer wants to inspect the dynamic or kine- 
matic performance of an assembly, he has to generate a model of the assembly for the analysis 
from the assembly draAvings. Also he has to regenerate the model whenever any component 
is modified. This additional step tends to lead the designer either to consider fewer design 
alternatives or to skip the analysis. 

Therefore, the main objectives of this work are: 

• To generate an integrated procedure by which the designer can create individual compo- 
nents, assemble them into an assembly and perform the dynamic and kinematic analysis. 

• To develop a method in which an assembly procedure is generated automatically from 
a description of an assembly provided by the designer. 
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Chapter 2 


Review of Mechanical Assembly 

2.1 Definition of Assembly 

Assembly sometimes designates the process and sometimes the product. Therefore, by 
process it can be defined as putting various parts together to create an end product and by 
product it may be defined as a collection of independent parts put together to perform some 
function. 

Assembly includes both reversible fastening processes (screwing, bolting...) and irre- 
versible ones (riveting, welding, glueing). 

2.2 Significance of Assembly 

In most engineering design, the product of interest is a combination of parts formed 
into an assembly. When the product is designed, consideration is generally given to the ease 
of manufacturing its individual parts and how the final product would look. Little attention is 
usually given to those aspects of design that will facilitate assembly of parts and great reliance 
is often placed on assembly or production engineers to solve any assembly-related problems. 
This approach worked well in the past because all the mechanical operations were performed 
manually, labor was inexpensive and because the products were not complex. As the products 
are becoming more complex and the labor is becoming more expensive, the demand to pay 
attention to the assembly process during the design phase of a product is becoming increasingly 
high. The most obvious way to facilitate the assembly process at the design phase is to simplify 
the product by reducing the number of different parts to a minimum. 

For automatic assembly, each product should have a base part (or a host part) on 
which the assembly can be built. This base part must be designed with features that make it 
suitable for quick and accurate location on the assembly line or work carrier. 

Apart from the assembly considerations at the design phase, which are discussed 
above, modeling and representation of assemblies are all relevant issues to geometric modeling 
and to the CAD/GAM technology. Parts and/or sub-assemblies of a given product can be 



modeled separately, most often by the different members of the design team. Instances of 
these parts can then be merged into the base part or the host to generate assembly. 

2.3 Assembly Modeling 

An assembly is a collection of independent parts. It is important to understand the 
nature and the structure of dependencies between parts in an assembly to be able to model 
the assembly properly. In order to determine, for example, whether a part can be moved and 
which other parts will move with it, the assembly model must include the spatial position and 
hierarchical relationship among the parts and assembly or attachment relationships (or mating 
conditions) between the parts. The modeling representation of hierarchical relationships and 
mating conditions are what distinguishes between modeling individual parts and assemblies, 
and consequently between geometric modelers and assembly modelers. 

Most of the existing modeling packages offered by today’s CAD/CAM systems that 
are in use in practice can be classified as geometric modelers. The data structure is designed 
to store and manipulate geometric data of individual parts only. Assembly modelers can be 
thought of as more advanced geometric modelers where the data structure is extended to 
allow representation and manipulation of hierarchical relationships and mating conditions. 
Fig.(2.1) shows how an assembly model can be created. The geometric modeler acts as a 
preprocessor to the assembly modeler. Designers first create all the shape information (both 
geometry and topology) of the individual parts. They can also analyze the parts separately. 
Part analysis may include mass property calculation and finite element analysis. Once the 
part design is complete, designers can utilize the assembly modelers to create the assembly 
and analyze it. Creating the assembly from its parts requires specifying the mating and spatial 
relationships between the parts. Assembly analysis may include interference checking, mass 
property calculation, kinematic and dynamic analysis, and finite element analysis. The link 
between the geometric modelers and assembly modelers is established such that designers need 
only to modify individual parts for design modification by using the geometric modeler, and 
the assembly model is updated automatically. 

There are three steps that are necessary for assembly modeling: 

• Modeling of individual parts. 

• Specifying the hierarchical relationship between parts in the assembly. 

• Specifying the mating conditions between parts or specifying the locations and orienta- 
tions of the parts in their assembled positions with reference to the host. 
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Model of 
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Model of 
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Part 2 
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Figure 2.1; Generation of an Assembly model 









2.3.1 Parts Modeling and Representation 

This is the first step in creating an assembly model. Individual parts can be created 
using a geometric modeler with the proper representation scheme. Solid modeling, specifically 
Boundary Representation, is the appropriate scheme because the mating conditions are related 
to the faces, edges and vertices of the assembled parts. In addition to the shape information, 
a part database can store assembly attributes such as the parts material type and properties, 
mass and inertial properties, frictional properties of the faces and others. 



Depth n, 
Hierarchy 0 


Figure 2.2: Assembly Tree 

2.3.2 Hierarchical Relationships 

The most natural way to represent the hierarchical relationships between the various 
parts of an assembly is an assembly tree as shown in Fig. (2.2). An assembly is divided into 
several assemblies at different levels. If there are n parts in the assembly then each sub- 
assembly at depth (n - 1) is composed of various parts. The leaves of the tree represent 
individual parts, its nodes represent sub-assemblies and its root represent assembly itself. The 



assembly is located at the top of the tree at depth 0 or at the highest hierarchy n of the 
assembly sequence. 

Fig. (2.3) shows a Cardan Universal Joint Assembly. The joint consist of four main 
elements: Yokes, a block, pins and bushes. Here, for the purpose of assembly the block is held 
stationary or assumed as the base (host) part. The other parts are located with respect to the 
base part and then assembled together. The assembly tree for this joint is shown in Fig. (2.4). 
The tree represents an assembly sequence by which the joint can be produced. The assembly 
tree is not unique as it is possible to generate other valid assembly sequences. 



Figure 2.3: Cardan Universal Joint Assembly 



Figure 2.4: Assembly Tree for tbe Cardan Universal Joint 




2.3.3 Specifying Mating Conditions 


Individual Parts of an assembly are usually created together separately using a CAD / CAM 
system and then merged together to form the assembly. The parts may have to be scaled up 
or down before merging to fit properly into the assembly. Each part has its own database 
with its own MCS (Model Coordinate System). Typically, the user selects one of the parts 
as a base part and merges the other parts into it. The MCS of the host becomes the global 
coordinate system for this part. 



Figure 2.5: Positioning individual parts into their corresponding assembly 

The final correct position of each part in the assembly is obtained by locating and 
orienting its corresponding MCS properly with respect to the global coordinate system of the 
assembly. Fig. (2.5) shows an example of positioning individual parts into their corresponding 
assembly. The XYZ is the global coordinate system of the assembly model with origin 0. ■ 



The Xi, Fi, Zi,X2, Y^, Z2, X3, F3, F3 and X4, F4, X4 are local coordinate systems of four parts 
that make the assembly. Their origins Oi, 02,03 and O4 are located properly relative to the 
assembly origin 0 and their orientations relative to the XYZ coordinate system reflect the 
proper orientation of the parts in their assembly. 

2.4 Assembly Sequence Planning 

As mentioned earlier, assembly may be defined as the process of fitting manufactured parts 
together into a complete machine, i.e., parts are joined together to form a functional unit. The 
fixing order of parts which is indirectly necessary to fit parts together to form a functional 
unit, is known as assembly sequence planning. Every functional component has one or more 
feasible assembly sequences. The development of feasible assembly sequence is a pre-task for 
product assembly planning. Few techniques exist to generate all assembly sequences, some of 
these techniques are manual while other are algorithmic. 

Few references for assembly sequence planning are given in the Reference section 



Chapter 3 

Assembly Procedures 


3.1 Approaches to represent an Assembly 

There axe two alternatives for representing an assembly depending on how the locations 
and orientations of its various parts are provided by the user. Accordingly, there are two 
approaches that exists to form assembly from a group of components. 

1. Homogeneous Transformation Matrix Approach. 

2. Mating Conditions Approach. 

These two approaches are discussed in details in the following sections. 

3.1.1 Homogeneous Transformation Matrix Approach 

The simplest alternative to represent an assembly is to specify the location and orien- 
tation of each part in the assembly, together with the representation of the parts itself, by 
providing a 4 x 4 homogeneous transformation matrix. This matrix transforms the coordinates 
of the geometric entities of the part from its local coordinate system to the global coordinate 
system of the assembly. One convenient way for the user to provide the transformation matrix 
interactively is by specifying the location of the local coordinate system of a part relative to 
the assembly global coordinate system and by forcing the orientation of the local system to 
coincide with the orientation of the proper WCS (Working Coordinate System). This WCS is 
defined relative to the assembly global coordinate system. 

As a WCS is completely defined by specifying its X and T axes or its AY" plane, the 
proper WCS used to merge a part into its assembly can be defined such that its A Y plane 
coincides with the AYplane of the part MCS . In other words, the WCS becomes the part local 
coordinate system after merging and in effect the transformation matrix relates the part MCS 
to the host MCS ( ^obal coordinate system of the assembly). This alternative of merging 
parts into their assemblies is commonly used in various CAD/CAM systerns. 








Let us consider an example of such instances as shown in Fig. (3.1). The assembly 
consists of two parts, A and B. Three instances of part B are used in the assembly. The user 
first provides the required information of both the parts with the MCS of each part as shown 
in the Fig.(3.1). Let us take part A as the base part. To create the assembly, the features 
of the host (holes on the faces) and the orientation of the instances must be properly aligned 
and then merge three instances of part B into it. 

3.1.2 Mating Conditions Approach 

This alternative to represent an assembly is based on specifying the spatial relationships 
between its individual parts as mating conditions. Mating feature information can be provided 
interactively with ease because mating features are simple graphic entities such as faces and 
center lines. For example, a mating condition can consists of planar faces butting up against 
each other. This is called as “ against” condition. It may require the center lines of individual 
parts to be collinear. This is called as “fits” condition. Therefore, by simply identifying mating 
conditions the assembly data can be provided interactively. Providing the assembly data as 
mating features seems more natural than defining WCS required by the earlier approach. 

By assigning the mating conditions, the transformation matrices that merge parts 
into their assembly can be automatically computed and stored for each part. In addition, 
using mating conditions instead of providing transformation matrices, determines whether or 
not the parts in assembly can be assembled. If some parts can not be physically assembled 
due to specifying inconsistent mating conditions, the transformation matrices satisfying all 
mating conditions do not exist. In this situation, the computation algorithm will diverge. 

In most assemblies, the mating features between a pair of parts satisfy the condi- 
tions of “against,” “fits,” “tight fits,” “contact,” and “coplanar.” A mating condition can 
be represented by its type and the two faces that mate. Soon we will discuss the relationship 
between the mating conditions and the actual position of the various parts. 

Against condition: 

The “against” condition holds between two planar faces, or between a planar face 
and a cylindrical face like shaft. This condition is illustrated in Fig. (3.2). Part 1 and part 2 
have the MCSs as YiZi and As Yz^s respectively. The faces shown with the normal drawn 
are the faces to be mated. Each face is specified by its unit normal vector and any one point 
on the face with respect to the part MCS. 

For example, the planar face of part 1 is specified by the unit normal fii, whose components 
are nia,, riiy, and and by the point Pi{xi, yi, zi) with respect to the coordinate 

system. The “against” condition is satisfied by forcing fii and ^2 to be opposite to each other, 
and two faces to touch each other. 
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Figure 3.2: “Against” condition between two planar faces 

Fits condition: 

The “ fits” condition holds between two cyhndrical faces: a shaft cylindrical face and 
the hole cylindrical face as shown in Fig. (3.3). The “fits” condition is achieved by forcing 
the shaft and hole axes to be collinear. Each axis is specified by two points. The hole axis is 
specified by the two points Pi (xi, yi, zi) and P 2 {x 2 , y 2 , ^ 2 ) defined with respect to the Xi Yi Zi 
coordinate system. Similarly, the shaft axis is specified by the two points P 3 {xs,ys,Z 3 ) and 
P4{x4,y4, Z4) defined with respect to the X 2 Y^Zs coordinate system. 

Contact and Tight fits condition: 

The “against” and “fits” conditions as described above allow both translational and 
rotational freedom of movement between the mating parts. In the “against” condition shown 
in Fig.(3.2), part 2 can slide on part 1 or rotate relative to it after the two faces designated 
by the two normals ni and fia are mated together. 


Ifi 








Similarly, in the fits” condition shown in Fig.(3.3), the shaft can slide and/or rotate 
inside the hole. There are some parts with the “ against” or “ fits” condition where rotational, 
translational or both are not permitted. The “contact” and “tight fits” conditions are intro- 
duced to handle these cases. The “contact” condition prevents the freedom of movement due 
to the against condition and the “ tight fits” prevents the freedom of movement due to the 
“fits” condition. 

The ‘ contact” condition is specified by requiring two points on the two mating parts 
to coincide. The “ contact” condition does not exclude the “ against” condition as former can 
allow rotation about the contact point. Consider the example shown in Fig. (3 .4). 

In this figure, faces are indicated indicated by the letter F with two subscripts. The 
first is the face number and second is the part to which the face belongs. For example, jF^,^ 
and Fi ^2 ^'^e the second face of part 1 and the first face of part 2 respectively. Other points 
follow a similar convention as shown. 

Part 1 


2,1 


F 


1,1 


1,1 



Figure 3.4: “Contact” condition 

The mating conditions between these two parts can be specified by three “ against” 
conditions: between and between F 2 ,i and F 2 ,b and between Fs^ and F3^2- With 
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these conditions specified only, part 1 should be free to move along the Z direction against 
Fs.z- If we specify the “contact” condition the points and are coincident, this 
undesired movement is eliminated. If only the “contact” condition is specified, part 1 can be 
tilted relative to part 2 and the proper faces may not be mated together. 

The “tight fits” condition is introduced to prevent the rotational movements that 
may accompany the “fits” condition. The “tight fits” condition describes fits between parts 
where the force to rotate one part relative to another is too great to be called the rotational 
degree of freedom. 

Coplanar condition: 

The “coplanar” condition holds between two planar faces when they lie in the same 
plane. This condition is illustrated in Fig. (3.5). It is similar to the “against” condition except 
that the points Pi and P-i are chosen to lie on the two edges to mate. The “ coplanar” condition 
is the complement of the “ against” condition, and is satisfied by forcing the two normals hi 
and ng to be in the same direction. 






Chapter 4 

Inferring Component Positions 


Up till now we have seen that there are two approaches that can be used to represent an 
assembly. Now let us see, how we can infer the positions of various individual components in 
the assembly by the two approaches we discussed earlier. 


4.1 Inferring positions by homogeneous transformation 
matrix approach 

Before getting into the details of this approach, let us first understand what is homoge- 
neous representation. 


4.1.1 Homogeneous Representation 


The various rigid-body geometric transformations are translation, scaling, mirroring and rota- 
tion. While transformations such as scaling, mirroring and rotation are in the form of matrix 
multiplication, translation takes the form of vector addition. This makes it inconvenient to 
concatenate the transformations involving translation. It is desirable, therefore, to express 
all the geometric transformations in the form of matrix multiplication only. Representing 
points by their homogeneous coordinates provides an effective way to unify the description of 
geometric transformations as matrix multiplications. 

In homogeneous representation, an n-dimensional space is mapped into {n + 1)- 
dimensional space, that is, a point (or a position vector) in n-dimensional space is represented 
by (n -t- 1) coordinates. In three-dimensional space, a point P with Cartesian coordinates 
{x, y, z) has the homogeneous coordinates {x*yy*, z*,]i), where h is any scalar factor 0. The 
two types of coordinates are related to each other by the following equations: 





(4.1) 


Eqs.(4.1) are based on the fact that if the Cartesian coordinates of a given point 
F are multiplied by a scalar factor h, P is scaled to new point P* and the coordinates of 
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P*2 ( X* y*z*h^) 



Figure 4.1: Homogeneous coordinates of point P 

P and P* are related by the above equations. Fig. (4.1) shows point P scaled by the two 
factors hi and to produce the two new points P* and Pj respectively. These two points 
could be interpreted in two different ways. Once the Cartesian coordinates of P* and Pj are 
calculated, their relationships to P do not exist any more. Moreover, the three points still 
belong to the Cartesian space. From a homogeneous coordinates point of view, the original 
point P is represented by {x*, y*, z*, hi) and (ccj, y^, Z 2 , / 12 ) respectively according to Eqs. (4.1). 
More importantly, the three points belong to the homogeneous space, with the Cartesian 
coordinates obtained when h = 1, and the relationship between P and P* or P| is maintained 
through the proper value of 7i. For the purpose of geometric transformations, the scalar factor 
/i used in Eqs.(4.1) is taken to be unity to avoid unnecessary division. Since translation and 
rotation are the major geometric transformations used in this work, we will discuss about them 
in short and see how they are achieved through the use of homogeneous coordinate system. 
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Figure 4.2: Translation of a curve 

Translation: 

When all the entities of a geometric model remains parallel to their original axes, the rigid 
body transformation is known as translation. Let us consider a point on a curve as shown in 
Fig.(4.2). This point is represented by a vector P. If we translate the curve by a vector d, 
the P occupies the new position as P* as shown. This translation can be written in terms of 
vector addition as 

P* = P + d (4-2) 

As discussed earlier, it is always convenient to write the transformations in terms of matric^, 
the translation transformation given by Eq.(4.2) can now be written as matrix multiplication 
by adding the component of 1 to each vector in the equation and using a 4 x 4 matrix as 

o-i 



follows: 


' 1 0 0 Xd' 


' X ■ 

0 1 0 Vi 


y 

o 

o 


V 

i 

tH 

o 

o 

o 

1 


. 1 . 


(4.3) 


P* = [D]P (4.4) 

Where [L>] is the translation matrix shown in Eq.(4.3). 

Rotation; 

Rotation is an important part of geometric transformation. It enables users to view geo- 
metric models from different angles and also helps many geometric operations. Rotation has 
unique characteristic that is not shared by translation, scaling, or reflection, that is, non- 
commutativeness. The final position and orientation of an entity after going through two 
subsequent translation, scaling, or reflection are independent of the operations, that is, com- 
mutative. On the contrary, two subsequent rotations of the entity about two different axes 
produce two different configurations depending on the order of rotations. 

Rotation about coordinate system axes: 

Rotating a point about a given angle 6 about the X, Y, or Z axis is sometimes referred to as 
rotation about the origin. 

To develop the rotational transformation of a point or a vector about one of the 
principal axes, let us consider the rotation of a point P at a positive angle 9 about the Z axis, 
as shown in Fig. (4.3). This case is equivalent to two-dimensional rotation of a point in the XY 
plane about the origin. The final position of point P is shown as point P*. The coordinates 
of the P* can be written as 

X* = rcos{9 + a) = rcosacos9 — rsmasinO 

y* =.rsin(9 + a) = rsirxacxisd -rcosasinO (4.5) 

z* = z 

Where, r = 1P| = IP* 1 

To eliminate the angle 6 from Eqs.(4.5), we can write (refer to the trigonometry in Fig. (4.3)) 

a; = rcosa! y = rsma (4.6) 

Substituting Eqs. (4,6) into Eqs. (4.5) gives 

X* = xc(^9 — xsinO 
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Figure 4.3: Rotation of a point about the Z axis 


y* = X cos 0 — x sin 0 
z* = z 


Rewriting Eqs.(4.7) in a matrix form gives 


’ X* ’ 


' cos 0 — sin 0 O' 


X ' 

y* 

= 

sin 0 cos 9 0 


y 

z* 


. 0 0 1 . 


. y . 


p* = [p,]p 



Where, 


[BJ 


COS0 

sin6> 
0 


— sin^ 

COS0 
0 


0 

0 

1 


(4.10) 


u * J 

Similarly, we can prove that matrices for rotations about JC and Y" axes are given by 


m 


1 0 
0 COS0 

0 sin0 


0 

— sin0 

COS0 


(4.11) 


[R,] = 


cos 6 0 sin 0 

0 10 
- sin 0 0 cos 6 


(4.12) 


Thus in general, we can write 

P* = [P]P (4.13) 

Where [R] is the appropriate rotational matrix. 

A closer look at the transformation matrices shows that they can all be embedded 
into one 4x4 matrix. This matrix takes the form: 


[T] 


<11 <12 <13 <14 



<21 <22 <23 <24 


■Pl T2' 

<31 <32 <33 <34 


.^ 31 . 

. <41 <42 <43 <44 . 




(4.14) 


The 3x3 submatrix [Ti] produces scaling, reflection, or rotation, the 3x1 column matrix 
[T 2 ] generates translation. The 1x3 matrix [Ts] produces perspective projection. The fourth 
diagonal element is the homogeneous-coordinates scalar factor h used in Eq.(4.1). 

Concatenated Rotation: 

Eqs.(4.10) to (4.12) shows the matrices for rotation about X, Y and Z axes respectively. 
Since series of rotations may be applied to a geometric model, combining or concatenating 
rotations is quite useful. Concatenated transformations are simply obtained by multiplying 
the [T] matrices in Eq.(4.14). In order to derive the rotation submatrix in the homogeneous 
transformation matrix, let us consider a point, or its position vector, in the fixed coordinate 
system XYZ, that is, MCS, by the following rotations in the following order: a about Z axis, 
P about Y axis, and 7 about the X axis. Substituting a, p and 7 in Eqs.(4.10), (4.12) and 
(4.11) respectively and multiplying, we obtain the concatenated rotation matrix as 

[T] = [TJ[T,][r.] (4.15) 


or 


■ [R] 0 ■ 


■ [B.1 

0 ■ 

■ft] 

0 ■ 

'm o' 

0 1 


0 

1 

0 

1 

0 1 


(4.16) 


nr* 



or 


(4.17) 


[B] = WlBjllBJ 


Expanding the above equation gives 


[R] = 


cacP 

sacj + cas^sj 
sas^ — caspc'Y 


We are using Eq.(4.18) as [Ti] in Eq.(4.14). 


—sacjS 

cac'Y — sas^sj 
cas'y + sasPcj 


— C^SJ 

cPcj 


(4.18) 


4.2 Inferring positions from mating conditions 

Figs. (3.2), (3.3), (3.5) show that satisfying mating conditions requires repositioning 
of the parts of the assembly. The inference of the location and orientation of a part in an 
assembly from mating conditions requires computing its transformation matrix from these 
conditions. This matrix relates the part’s local coordinate system to the global coordinate 
system of the assembly. With reference to Fig. (2.5), the location of part 1 is represented by 
the vector OOi connecting the origin 0 of the assembly global coordinate system to the origin 
Oi of the Xi YiZi local coordinate system of the part. The orientation is represented by the 
rotation matrix between the two systems. The transformation matrix can be written as 



rrix 

Qx 

rx 

X 

rriy 

% 


y 

rriz 

Qz 

Tz 

z 

0 

0 

0 

1 


(4.19) 


This matrix has twelve variables. Out of twelve variables, nine are rotational and three 
are translational variables. These variables must be determined from mating conditions. For 
an assembly of imparts, and choosing one of them as base part, N — 1 transformation matrices 
have to be computed. Therefore, variables to solve for simultaneously are the 12 x (iV — 1) 
elements of these matrices. 

In a typical assembly, the mating conditions between two components are not enough 
by themselves to completely constrain the two components. An intertwinement of mating 
conditions usually exists between all of the parts. In general, a group of parts must be 
solved simultaneously. The mating conditions along with the transformation matrix properties 
provide the constraint equations necessary to solve for the 12 x (W - 1) variables. The number 
of equations is always equal to or greater than the number of variables. Therefore the method 
of solution should account for the number of redundant equations, and eliminate these equation 
from the system of equations to be solved. 

Before discussing the algorithms to solve for the unknown variables, the development 
of constraint equations from mating conditions is presented. We will discuss the three basic the 
three basic mating conditions: “against,” “fits,” and “coplanar.” For the “against” condition 
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shown in Fig. (3.2), each face where the two part mate is specified by a unit normal and a 
point described in the local coordinate system of its corresponding part. Let [Ti] and [T 2 ] be 
the transformation matrices from the XiYiZi and JC 2 Y 2 Y 2 coordinate system respectively to 
the global coordinate system of the assembly. The unit normals and two points specifying the 
mating conditions can be expressed in terms of the XY Z system as follows: 


and 
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(4.20) 

(4.21) 

(4.22) 


■ X2“ ■ 


■ X2 ■ 

2 / 2 “ 

Z2°‘ 

= [^2] 

y2 

Z2 

1 


. 0 . 


(4.23) 


In the above equations, the superscript a indicates assembly. The “ against” condition 
requires the direction of the two unit normals to be equal and opposite and the two points to 
lie in the same plane at which the two faces mate. These can be expressed by the following 
four equations: | 
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lx 


= —n; 


'2x 


nty = -^2y 
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(4.24) I 

(4.25) I 

(4.26) 

j 

(4.27) 
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Hence, four equations [(4.24) to (4.27)] are required for each “against” condition to 
be satisfied. 

The “ fits” condition requires that the center lines of the shaft and the hole be collinear 
as shown in Fig. (3.3). The equation of the centerline can be written as 



(4.28) 


x-x^ _ y-y^ _ X- 

^2~xf~yi-yf~ z^-zt 

If the shaft axis is collinear with the hole centerline, points P3 and P 4 defining the axis should 
satisfy Eq.(4.28). The points must first be transformed using [T2] to the assembly global 
coordinate system. The constraint equations required for each “fits” condition can be written 
as 


3 ^ 3 -^! _ Vs - Vl ^ X^-zf 
X2 — X I yf — yf z^ - zf 

xj-xf ^ yt-yf ^ xj-zf 
X2 -xf y^-yt z^- zf 


(4.29) 

(4.30) 


Each of the above equations yields three combinations of equations resulting in a total of six 
equations for each “ fits” condition. In general, two of these equations are redundant because 
Eqs.(4.29) and (4.30) each yields only two independent equations instead of three, however it 
is necessary to carry out all the three to cover the cases where the centerline passing through 
points Pi and P2 is parallel to any of the global coordinate axes. For example, if the centerline 
is parallel to the X axis as shown in Fig. (3.3), Eq.(4.29) becomes 


3^3 -^1 ^ yl-Vi ^ xt-zf 
X 2 — xf 0 0 


(4.31) 


Which gives the following two equations only: 

{y 3 -yt){^ 2 -xt) = o (4.32) 

{zl-zf){x^-xf) = 0 (4.33) 

Hence, it can be seen that all three equations must be carried out so that at least 
two independent equations can be written for all cases, although this introduces redundancy 
in the system of equations. 

The constraint equations for the “ coplanar” condition are the same as for the “ against” 
condition except that the two unit normals have to be in the same direction as shown in 

Fig.(3.5). Thus Eqs. (4.24) to (4.27) can be used after replacing the minus sign in Eqs.(4.24) 

to (4.26) with a plus sign. 

One last constraint equation can be written and applies to all free rotating parts in 
the assembly such as bolts, pins, shafts, etc. A firee rotating part is defined here as a part 
that rotates freely about a centerline axis. The rotation of these parts usually does not alter 
the appearance of the assembly. Thus this condition is called as “free rotation.” Therefore, 
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there can be infinitely possible orientations of a free rotating part. Fig. (4.1) shows a bolt 
with its XiYiZi local coordinate system oriented in the XYZ global coordinate system of the 
assembly. The bolt can rotate freely about its Xi axis by an angle 0. As seen from the figure, 
the orientation of the Yi and Zi axes are insignificant to the assembly. If this free rotation 
is not constrained, the calculations of the transformation matrix firom the mating conditions 
will diverge. As long as the angle (j) is arbitrary, it can be set to zero, that is, 

<^ = 0 (4.34) 

This constraint equation represents the constraint equation associated with firee ro- 
tating parts. With reference to Fig. (4.4), Eq.(4.34) is equivalent to two equations; 

0 = 6 = 0 (4.35) 

Where a and 6 are the components of the unit vectors (along the Yi and Zi axes) in 
the Z\ and YI directions respectively. If the Xx axis is coincident with the X axis of the global 
coordinate system of the assembly, Eq.(4.35) can be written in terms of the elements of the 
transformation matrix given by Eq.(4.19) as 

Qz ~ ^ (4.36) 

For a part rotating freely about its Yl axis or Zi axis, we can write respectively 

mz=rx = 0 (4-37) 

my = qx = 0 (4.38) ! 

With all the constraint equations derived for the various mating conditions, we can 
now calculate the total number of equations and unknowns that can be used to infer the 
positions of a part from mating conditions. For each “ against” condition, 16 equation can 
be written: 12 are provided by Eqs.(4.20) to (4.23) and the other 4 Eqs. (4.24) to (4.27). j 

For each “fits” condition, 18 equations can be written: 12 are provided by Eqs. (4.20) to i 

(4.23) and the other 6 are Eqs. (4.29) to (4.30). The “coplanar” condition provides the same 
number of equations as the “against” condition. For each firee rotating part, two equations 
[Eqs. (4.36), (4.37), or (4.38)] are available. In addition, the properties of the transformation 
matrix [Eq. (4.19)] provides six equations: three from the unit vector length property and three 
from the orthogonality property. These can be written as : 


ml rriy + ml = 1 

(4.39) 

qI + qI + Qz = ^ 

(4.40) 


(4.41) 
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Tx = myqz - m^qy (4.42) 

'^y — '^zQx '^xQz (4.43) 

Vz — Tflxqy ^y?a! (4.44) 

For an assembly of N parts, the total number of equations that can be written is 

given by 

M = 6(Ar - 1) + 16iVA + 1%NC + ISiVF + 2NR (4.45) 

Where NA, NC, NF and NR are respectively the number of “against,” “coplanar,” “fits,” 
and “ free rotation” conditions. The number of variables are 


V = 12(iV - 1) + 12(iVA + iVC + NF) 


(4.46) 


The first term of this equation represents the elements of the {N — 1) transforma- 
tion matrices and the second term is the number of variables introduced by the “against,” 
“coplanar,” “fits,” conditions. Each condition introduces 12 variables: 6 components of the 
unit normal vectors hi and h2 and 6 coordinates of the two points Pi and P2 (or P3 and P4) 
for the “fits” condition). Equations (4.45) and (4.46) show that the number of equations and 
the number of variables are not equal. In general, the former is always equal to or greater 
than the latter. 

The representation of the transformation matrix by Eq.(4.19) increases both the num- 
ber of variables and the number of equations, which in turn makes finding a solution an expen- 
sive proposition. In an effort to reduce the number of variables, Eq.(4.19) may be rewritten 
using the following approach. The position of a part is still given by the elements x, y and z. 
The orientation can be described by a sequence of rotation about the X, F and Z axes in- 
stead of using the components of the unit vectors as given by the nine elements of the rotation 
matrix. Let us assume that the local coordinate system of a part can be oriented properly in 
its assembly by three rotations about the axes of the global coordinate system in the following 
order: (x about the Z axis, jS about the Y axis, and 7 about the X axis. Thus, we can rewrite 
Eq.(4.19) as 


[r] = 


■ 1 0 0 a: ■ 


0 

1 

0 1 0 y 


[il] 0 

0 0 1 z 


0 

0 0 0 1 . 


. 0 0 0 1. 


(4.47) 


Where [^] is given by Eq.(4.18). 

Using Eq.(4.47) instead of Eq.(4.19) reduces the number of variables per matrix almost 
by half: from 12 to 6 and they are a, /5, 7, x, y, z. Consequently, six equations[Eqs. (4.39) 
to (4.44)] are eliminated. In addition only one constraint equation [Eq.(4.34)] is used for free 
rotation. To reduce the number of equations and variables even further, we can eliminate the 
12 variables (global description of unit normals and points) given by Eqs. (4.20) to (4.23) by 



considering them known in terms of the transformation matrix. Thus, Eqs. (4.45) and (4.46) 
become respectively 

M = ANA + ANC + 6NF + NR (4.48) 

V = Q{N- 1) (4.49) 

To simplify the implementation of the free rotation condition, we can define the Z 
as the axis of free rotation. Therefore the angle <j) in Eq.(4.34) is about this axis. If the free 
rotating axis is the Y axis, we will assume rotation about this axis which is given by 7 to be 


zero. 



Chapter 5 

Solution Schemes 


5.1 Homogeneous Trcinsformation Matrix Approach 


As mentioned earlier, the simplest alternative of representing an assembly is to specify 
the location and orientation of each part in the assembly, together with the representation 


of the part itself, by providing a 4 x 4 homogeneous transformation matrix. Homogeneous 
transformation matrix is given by Eq.(4.19). Where, location is obtained by three translational 
elements and orientation by 9 rotational elements. We have also seen that the 9 rotational 
elements can always be described by a sequence of rotations about the X, F, or .Z axes instead 
of using the components of the unit vectors as given by the nine elements of rotation matrix. 
Rewriting Eq. (4. 14), 


[T] = 


Ti T2 

Tz 1 


(5.1) 


Where, [Ti] is the rotational matrix given by Eq.(4.18), [T2] is a translational 3x1 column 
matrix, [Tz] is 1 x 3 row matrix producing the perspective projection. Here, for convenience, 
we will assume all the elements of [Tz] to be zero. After proper substitution, the homogeneous 
transformation matrix becomes 


[Tl = 


cacP —sacjS 

sacy + cas0s'y cacj — sas^s'y 
sas'Y — cas^cy casj + sas^oy 
0 0 


Sp X ' 

-c^S'r y 
c^cy z 
0 1 


(5.2) 


Now, let us assume that we have represented all the components of the assembly in a WCS in 
such a way that for any two parts, which are going to assemble, their faces are against each 
other, that is, their corresponding normals are opposite to each other. Under this situation 
orientation of the local coordinate system of the parts local coordinate system is same as the 
global coordinate system of the base part. So we need not compute a, /? and 7 variables 
in homogeneous transformation matrix given by Eq.(5.2). Therefore, we will assume these 
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variables to be zero. Then, Eq.(5.2) becomes 


■ 1 0 0 a; 

0 1 0 y 

0 0 1 

0 0 0 1 


(5.3) 


Let us consider a point P which after translation occupies a new position as P*. Then, P and 
P* are related by the following equation. 


P* = [T]P (5.4) 

For any general assembly problem, since we know the final position of the part in the assembly 
together with its initial position, we can say that we know P* and P. So our task boils down 
to finding x, y and z component of the Eq.(5.3) using Eq.(5.4). 

The solution scheme is given below 

Let us consider S and I as a 4 x 1 column matrices given as follows 



■ X ■ 


' 1 ■ 

y 

1 = 

1 

z 


1 

. 1 . 


. 0 . 


For convenience, let us substitute x = y = z = lm Eq.(5.3) temporarily, we get [T] as 


[r] = 


■ 1 
0 
0 
0 


0 0 1 ' 
1 0 1 
0 1 1 
0 0 1 


Since we know P and P*, we will designate the product of [T] and P as TP [from Eq.(5.4)] 
which is 4 X 1 column matrix. Then we get S, which is our solution vector by following 
equation 


S = P*-TP-I 

Thus, we obtain the values of variables x, y and z. 

In few assembly cases, it may so happen that the faces of the mating parts may not 
be opposite to each other although their corresponding coordinate systems are parallel to each 
other. In such situations, we will compare the normals of the corresponding faces of the two 
components of the assembly and rotate one of the component to make their faces opposite. 



5.2 Solution Scheme for Mating Conditions Approach 

We will now discuss the solution scheme for the system of equations that result from 
3'PPlyi^S til® mating conditions. This system is nonlinear due to the trigonometric functions 
that appear in the transformation matrix [T]. Since the number of equations is equal to 
or exceeds the number of variables, a method is needed to remove the redundant equations. 
The method discussed here utilizes the least square technique to eliminate the redundancy 
first, followed by using the Newton Raphson iteration method to solve the resulting set of 
independent equations. The Newton-Raphson method for n nonlinear equations of n variables 
can be written as 

Xk+i = Xk + [J{Xk)]~^Rk (5.5) 

Where Xh is the solution vector at the iteration, [J(Xjfc)] is the Jacobian matrix and R). is 
the residual vector. Both of which are evaluated at the current solution vector Xk- 

When redundancy exists, the inverse of the Jacobian may not exist because the Ja- 
cobian itself may not be square and/or it may be singular. The following procedure can be 
used to solve for n variables (X = [xi x^-.. XnY') using the following m equations: 

f2{Xl,X2,...,Xn) =0 (5.6) 


fm{Xl,X2:...,Xn) = 0 

In vector form, Eqs,(5.6) becomes 

F{X) = 0 (5.7) 

To write Eqs.(5.6) in Newton-Raphson iterative form, let us assume that a solution Xi exists 
at step i and the solution at step ? + 1 is Xj+i such that 

Xi+i = Xi + AXi (5.8) 


(5.9) 


(5.10) 


Lmeariziixg Eqs* (5.8) about gives 

FM=Fi + ^^^AX, 

If JTi+i is the solution, then Eq.(5.7) holds, that is, Fi+i = 0. Thus Eq.(5.9) becomes 
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This can be written as: 

[J]iAXi = Ri (5.12) 

Where [J]i = [J(Xi)], AXi, and Ri are the Jacobian matrix, the incremental solution vector 
and the residual vector at iteration i respectively. The Jacobian [J(Xi)] is a nonsquare matrix 
of size mx n. 

The least-squares method may be used to solve Eq.(5.12) for AXj. The method is 
based on multiplying both sides of Eq.(5.12) by that is, 


[J\^[J\AXi = [J\^Ri (5.13) 

Solving this equation for AXi gives 

AXi = [^J]r\j\i^Ri (5.14) 

The algorithm to solve for AXi can described as follows: 

An initial guess Xq is made. The Jacobian [J]o and the residual vector Rq are computed. 
Next Eq.(5.14) is used to calculate AXq. Finally, Eq.(5.8) is used to compute Xi. These steps 
are repeated to obtain AXi and X 2 , AX 2 and X 3 ,. . . , and AX„_i and Xn. Convergence is 
achieved when the elenaents of the residual vector R or the incremental solution vector AX 
approaches zero. 

• We have already mentioned that convergence is obtained when the residual or incremen- 
tal vector approaches zero. In the present work, for all the cases solved, if we calculate 
Ri, we find it to be zero, therefore AXi = 0 and X 2 = Xi, Thus Xi is the solution. 
Actually, it is the exact solution. Therefore, we do not go for further iterations using 
Newton-Raphson method. 





Chapter 6 


Results and Discussions 


6.1 Cases Solved 

It is always useful when studying the assembly of a product to identify the various ways in 
which the assembly process may be carried out. In most assemblies, there are more than 
one assembling sequence to generate assemblies from their respective parts. An assembly or 
production engineer must decide on the most optimum sequence. 

Few techniques exist to generate all assembly sequences, some of these techniques are 
manual while other are algorithmic. A precedence diagram may be designed to show all the 
possible assembly sequences. In this work, although there are many possible sequences, a most 

convenient assembly sequence has been followed. 

Following cases have been solved successfully using both the approaches. In all the 

cases a manual assembly sequence is being used. 

1. Cardan Universal Joint Assembly. 

2. Clamp Assembly. 

3. Protective Flange Coupling Assembly. 

4. Problem involving different mating conditions. 

5. Problem of instances. 

In the first three cases, we have drawn the assembly tree that shows the spatial 
relationships between various components of assembly. For all the cases, no tolerances are 
provided on dimensions of the components and the fits between the various components of an 
assembly are assumed to be “interference fits. 
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Figure 6.2: Assembly tree of Cardan Universal Joint 
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Figiir6 6.8' AssBinbly tree of Protoctive FlaxigB CoTipling 





Figure 6.9: Assembly of Protective Flange Coupling 
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Figure 6.H: Assembly: Problem of Dijfferent Mating Gouditions 
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Figure 6. 12: Problem of Instances 



Figure 6.13: Problem of Instances 


Chapter 7 

Conclusions and Future Work 


7.1 Conclusions 

This project began with the aim of providing a simple and user friendly assembly modeling 
system for all mechanical parts. This is achieved using two algorithms as we discussed earlier. 
These two algorithms were successfully tested for performing different mechanical assemblies 
with different mating conditions. Although both the algorithms require the user to input the 
necessary geometric information, each of them has its own advantages. We will discuss them 
in brief 

• In Homogeneous Transformation Matrix algorithm, user has to input the initial and final 
positions of the various parts in the assembly and then algorithm evaluates the proper 
translations. This is the simplest way of representing an assembly. Where as, in Mating 
Conditions algorithm besides giving the necessary geometric information, user has to 
derive the Jacobian matrix from mating conditions in hand. This makes the algorithm 
relatively clumsy. 

• The Homogeneous Transformation Matrix algorithm can only find out the translations 
and not the required rotations. So its use is limited for the cases where all the parts 
have local coordinate system parallel to the global coordinate system of the base part. 
Whereas, the Mating Conditions algorithm is capable of calculating the orientations 
of the various parts in the assembly if their coordinates are parallel to one plane and 
inclined to the remaining two planes. 

• Both the algorithms can be used to perform the assembly from given set of components. 
But one has to select the approach depending on the type of mating conditions involved 
in the assembly. If assembly has the parts with orientation same as that of the base 
part. Homogeneous Transformation Matrix algorithm suffices. Whereas, if the assembly 
has few parts whose orientations are not same as that of the base part, one has to go for 
the Mating Conditions algorithm. 
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• I'hrough the employment of the interactive assembling the designer may concentrate 
more time upon the analysis and performance of an assembly once this analysis has 
been added to this work. He will also be less apprehensive about considering other 
assembly alternatives knowing that such a tool is at his disposal. 

7.2 Scope for Further Work 

Although this work is completed only up to the assembly modeling stage, one can extend it 
beyond this. Few of these possible extensions are discussed below: 

• Analysis: 

Among the popular analysis tools are the cross-sectional views of the assemblies, 
mass property calculations, inference checking, finite element analysis. Thus extending 
this approach the user can analyse individual parts separately or group of them. 

• Simulation: 

Similarly, one can simulate the assembly to perform kinematic and dynamic anal- 
ysis on it and evaluate the performance. 

• Automatic Assembly Sequence Generation: 

Since, we have used the mating conditions for inferring positions of the parts in the 
assembly, we can develop an algorithm that will give us different possible sequences from 
mating conditions. Then it would be very easy to find out the most optimal sequence. 

• Computer-controlled robots: 

Finally, this work may be linked to the task-level programming of a robot for 
the assembly task which uses a coding system to generate a program for manipulating 
computer controlled robots. A coding system consists of many general procedures. The 
system is given component descriptions necessary for initiating the general procedure 
(e.g. coordinate of the component, grasp point etc.) according to the sequence m which 
the components are assembled. So the sequence of instantiated procedures forms an 

assembly instruction program to control the robot. 
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Appendix (A) 

Functions used for Code 

/*=!=♦ Function for Matrix Multiplication ***/ 

GLfloat matriml( GLint x, GLint r, GLint y, GLfloat *p, GLfloat *q, GLfloat *z ) 

{ 

GLint i, j, m, n, k] 

GLjfioat prod, i(;i[15][15], iy2[15][15], W3[15][15]; 

for(i = 0, j = 0;i < x,j <r;i + +,j + +) 

{ 

= 0-0; 

Wi[i][j] = *p-, 

+ +; 

} 

for(i = 0,i = 0;i < r,j < y,i + +,j + +) 

{ 

W2[i][j] = 0 . 0 ; 

W2[i][j] = *<1', 

*q 4- +; 

} 

for(m = 0,n^0;m<x,n< y,m + +,n + +) 

{ 

prod = 0; 

for(fc 0; A; < r; jfe + +) 

{ 

^y3[*][i] = 0.0; 

prod — prod + 

•u; 3 [m][n] = prod, 

} 

} 

for(m = 0, n === 0; m < a;, n < y; TO + +, Ti + +) 

= wz[rri\[n]-, 

♦;2 + +; 


r'f*. 



} 


} 

/*** Function for Matrix Inversion ***/ 

GLfioat matmv( GLint x, GLint y, GLfloat *w, GLfloat ^(=5 ) 

{ 

GLfloat I [10] [10] , m[l0] [15] , n[10] [15] , a[10] [15] ; 

GLint i,j,k] 

fox{i = 0,j = 0-,i<x,j <y;i + +J + +) 

{ 

l['i]\J] = 0 . 0 ; 
l\i]\j] = *wi 
*w + +; 

} 

/*** Procedure for augmented matrix ***/ 

for(i = OJ = 0-,i < xj < {y + xy,i + +,j + +) 

{ 

a[t][jt] = 0.0; 
if{j >= x) 
a[i][i + x] = 1.0; 
else 

a[i]b1 = 0.0; 

} 

for(j = 0,jf = 0;i < x, j < x]i + +J + +) 

aWbi = imy, 

iov{i = Q,j — 0]i<x,j <{y + xyi + +,j + +) 

{ 

n[i]b] = 0.0; 
m[i][ji']=0.0; 

m[i][i] = a[z][i]; 

} 

/* ♦ * Does matrix inversion by G-J method ♦ * */ 
foT{k-Q,i = ^',k<x,i<x]k + +,i + +) 

{ ■ 

for(i = 0; i < (y + a;); j + +) 

{ 



if{A: > 0) 

'm[i][j] = n[i][i]; 

if(j == k) 

n[%\\j] = m[i\\j]/m\i][k]‘, 
else 

n[i]L?] = 

} 

for(i = 0, j = 0; i < x, j < (y + x)] i + +J + +) 

{ 

if(i! = k) 

n[i]\j] = m[{\\j] - m\i][k] * n[k][j]] 

} 

} 

for(i = 0, j = y,i< x,j < {y + xy,i + +J-\-+) 

{ 

= n[i]\j]] 

*s + +; 

} 


} 



Appendix (B) 

Code for Homogeneous Transformation Matrix 

Approach 

Assigns the rotational matrix for a, ^ and 7 values ***/ 

GLfioat assmat( GLfloat xa, GLfloat ya, GLfioat za, GLfloat *tmt ) 

{ 

GLfloat ax, ay, az, al, bt, gm, imat[4][4]; 
ax = xa; ay = ya; az = za; 


al = (az * FJ)/180.0; 
bt = {ay*PI)/m.O] 
gm ~ {ax * PI)/180.0; 

tmat[0][0] = cos{al) * cos{U); 
tmat[Q][l] = -sinial) *cos{bt); 
tmat[0][2] = sin{bt); 
tmat[0][3] = 0.0; 

tmat[l][0] = sin{al) * cos{gm) + cos{al) * sin{bt) * sin{gm); 

= cos{al) * cos{gm) - sin{al) * sin{bt) * sin{gm); 

tmat[l][2] = ~cos{bt) * 8in{gm); 

tmat[l][3] = 0.0; 

<7nat[2][0] = 8in{al) ♦ sin{gm) - co8{al) * 8in{bt) * co8{gm); 
tmat[2][l] = cosial) * + sin{al) * sin{bt) * co8{gm); 

tmat[2][2] = cos{bt) * co8{gm); 
tmat[2][Z] = 0«0; 

tmat[Z][0] = 0.0; 
trmt[3][l] ~ 0.0; 
tmat[3][2] = 0.0; 
tmat[3][3] = 1.0; 

for(i = 0, i == 0; « < 4, i < 4; i + +, i + +) 

{ 

*tmt = tmat[i]\j]; 

Mmt + +; 


J-'O. 



} 


} 

* >(< Calculates the x, y and z components of translation when the normals of the mating 
faces are already opposite ***/ 

GLjfioat calxyz( GLfloat *ci, GLfloat * 03 , GLfloat *x, GLfloat *y, GLfloat *z ) 

{ 

GLfloat pi [4] [1] , P 3 [4] [1] ; 

GLfloat tmat[4][4],mimat[4][4],pro[4][l],mpro[4][l],/co£i[4][l]; 

GLfloat rm[4][l] = {1.0, 1.0, 1.0, 0.0}; 


for(t = 0,j = 0;i < 4, j < l]i + +,j + +) 

{ 

= *cl + +; 

= *^ 3 ; *c3 + +; 

} 

/*** Calling the rotational matrix assignment function ***/ 
assmat(0.0, 0.0, 0.0, &iTnot[0][0]); 

for(i = 0, i = 0; i < 4, i < 4; i + +, i + +) 

{ 

ifO' > 2) 

[}]==! -0; 
else 

mtmat[i]lj] = tmat[i]\j]‘, 

} 

/*** Calling the matrix multiplication function ***/ 

raatmul(4, 4, 1, &mtmal[0]i0], &:p3[0][0], fejwolOlM)) 

for(* — 0> i = 0) * < 

TOpro[i] [?■] = pro[i] [;] -- Wj 

} 

♦X == /corflo][o]; 


} 


ifz = fcod[2][0]; 



/, * » Calculates the x, y and z components of translation when the normals of the mating 
faces are not opposite ***/ 

GLfloat caJxy.( GLfloat GMoat ,03, GLfloat GLfloat xa. GLfloat ya, GLfloat aa. 
GLfloat GLfloat *y, GLfloat *z ) 

{ 

GLfloatpi[4][l],p3[4][l]; 

GLfloat tmat[i\ [41. mtmat[i] [4] , prol4] [1], mproU] [1], /co<i[4] [1]; 

GLfloat ))33[4][l],p3,[41[l],m«[4][4),np3[41[l]; 

GLfloat rm[4][l] = {1.0, 1.0, 1.0, 0.0}; 

for(i = 0; « < 4; i + +) 
for('? = 0;i < l;i + +) 

{ 

PiW[i]==*ci; *ci + +; 

P3\i]\j] = *cs; *C3 + +; 

P3i[*][?] ~ *Ct', *ct + +; 

} 

/* * * Translating the initial position vector towards origin * * */ 
for(i = 0; i < 4; i + +) 
for(i = 0;i < l;i + +) 

/*** Finding the coordinates of the initial position vector 
after corresponding rotation about origin ***/ 
as8mat(a;a, ya^ za, &:mt[0][0]); 
matmul(4, 4, 1, &mt[0][0], &:jj33[0][0], &np33[0][0]); 

♦ Translating the initial position vector back to its original position ***/ 
for(i = 0; « < 4; i + +) 
for(i = 0;i < l;i + +) 
np3s[iM-np3z[i]\j]+P3S]\j]l 

/*** Calling the rotational matrix assignment function ***/ 
aflsmat(0.0, 0.0, 0.0, &imat[0][0]); 
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for(i = 0; i < 4; i + +) 
for(j = 0;i < 4; j + +) 

{ 

if(j > 2) 

rntmat[i][j] = 1.0; 
else 

mtmat[i][j] = tmat[i]\j]-, 

} 

/* * * Calling the matrix multiplication function ***/ 

matmul(4, 4, 1, &;mtmot[0][0], &nj333[0][0], &pro[0][0]); 

for(i = 0; i < 4; * + +) 
for(j = 0;j < l;j ++) 

{ 

mpro[i\\j] = proW] - rm[i]\j]\ 
fcod\i][j] = Pi[{\\j] - mpro\i]\j]-, 

} 


} 


*x s= fcod[Q][0]; *y = /cod[l][0]; *z = fcod[2][0]; 



Appendix (C) 

Code for Mating Conditions Approach 

/* * * Function for calculating a, P, j, x , y and z variables using Mating Conditions 
Approach ***/ 

GLfloat calxyz( GLint dir, GLint s, GLfloat *pu, GLfloat *p22, GLfloat *^ 33 , GLfloat *^ 44 , 
GLfioat *tx, GLfloat *ty, GLfloat *tg ) 

{ 

/* * * Variable Declaration ***/ 

GLfloat jac[9][6],trjac[6][9],protrjac[6][Q], invprotrjac[6][6]‘, 

GLfloat slpro[Q] [9] , fpro[6] [ 1 ] , resv [9] [ 1 ] ; 

GLfloat xi, yi, zu X2, y^, z^, X 3 , y^, zz, X 4 , 1 / 4 , Z4; 

GLfloat Pi[3 ],]?2[3],P3[3],P4[3]; 

GLfloat gamma, beta, alpha, gm, bt, al, x, y, z] 

for(i = 0; z < 3; z + +) 

{ 

pi[i] = *Pn',*Pn + +\ 

P2[i] = *P22', *P22 + +; 

P3[z] = *Pz3] *jP33 + +; 

P4[i] = *^ 44 ; *pu + +; 

} 

= Pi[o]; yi = pi[i]; = Pi[2]; 

X2 = P2[0]; y2 = P2[l]; % = P2[2]; 
if(s ssrs 1 ) 

{ 

xz “ P3[0]; yz - P3[i]; ^3 = P3[2]; 

3 J 4 ~ P4[0]) y4L P4[l]) ■^4 P4[2]) 

} 

else 

{ 

xs = P4[0]; P3 = P4[l]; ^3 = P4[2]; 

X 4 = p3[o]; p4 = PsW; 2 : 4 = P3[2]; 

> \ 

x = 0.0;y = 0.0;z = 0.0; 

gamma — 0.0',beta — O-Ojalpha ~ 0.0', 


gm == {PI * gamma)/lS0.0; 





bt = (PI * 6eto)/180.0; 
al = (PI * alpha)/lSO.O; 
switch (dir) 

{ 

case 1: /*** Parallel to X axis ***/ 

jac[0] [0] = -sin(al) =i= cos(bt)i /*** Jacobian Matrix ***/ 

jac[0][l] = ~cos(al) * sin(bt); 

jac[0][2] = 0.0; 

jac[0][3] = 0.0; 

jac[0][4] = 0.0; 

jac[0][5] = 0.0; 

jac[l][0] = (cos(al) * cos(gm)) — (sin(al) * sin(bt) * sin(gm))] 

jac[l][l] = cos(al) * cos(bt) * sin(gm)\ 

jac[l][2] = ~(sin(al) * sin(gm)) + (cos(al) * sin(bt) * cos(gTn))', 

jac[l][3] = 0.0; 

jac[l][4] = 0.0; 

jac[l][5] = 0.0; 

jac[2][0] = (cos(al) * sin(gm)) + (sin(al) * sin(bt) * cos(gm))i 

jac[2][l] = -cos(al) * cosipt) ♦ cos(gm)\ 

jac[2][2] = (sin(al) * cos(gm)) + (cos(al) * sin(bt) * sin(gm)); 

jac[2][3] = 0.0; 

jac[2][4] = 0.0; 

jac[2][5] == 0.0; 

jac[3][0] = -(2.0 ♦ asa * cos(al) * sin(al) * cos(bt) * cos(bt))+ 

(ys * 3 in(al) ♦ 8 in(al) * cos(bt) * cos(bt))- (yz *cos(al) * cos(al) * cos(bt) * cos(bt)) 
(zz * sin(bt) * 8 in(al) * C 08 (bt)) - (x * sm(al) * cos(bt))+ 

(xi * sin(al) ♦ cos(ht)) -f (2.0 *X 3 * 8 in(al) * cos(al) * cos(gm) * cos(gm))- 

(yz*co 8 (al)*cos(aI)*co 8 (gm)*cos(gm))— 

(y 3 * 8 in(ar)*sin(al)*cos(gm)*cos(gm))+ 

(2.0 * zz * cos(bt) * 8in(gm) * cos(cd) * cos(gm))+ 

(y*co8(al)*cos(gm))-(yi*cos(al)*cos(gm))- 

(2.0 * Xz * a)s(al) * 8in(al) * sin(bt) * sin(bt) * sin(gm) * sin(gm))+ 

(yz * sin(al) * 8m(al) * sin(bt) * 8 in(bt) * sin(gm) * sin(gm))— 

(ya * co 8 (al) * cos(al) * sin(bt) + 8 in(bt) * sin(gm) * sin(^m^- 
(zz * co 8 (bt) * sin(bt) * 8 m(al) * sin(gm) * sin(gm))- 



{y * sin{al) ♦ sin{bt) * sin{gm)+ 

{yi * sin(al) * sin(bt) * sin{gm)) 

+( 2.0 *xz* sin{al) * cos{al) * sin{gm) * sin{gm))— 

(2/3 * sinioX) * siniaX) * sin{gTn) * si7i(^m))+ 

(2/3 * cos{al) * cos{al) * sin{gm) * sin{gm))+ 

[z * costal) * sini^gm))— (zi * cos(al) * sin[gm))— 

(2.0 * X'i * cosiaX) * sin{a,t) * sinipt') * sinpt) * cosl^gni) * cos(p 7 Ti))+ 
ivs * sin^al) * siniai) * sinpt) * sin{bt) * cos[grnj * cosi^gm))— 

(?/3 * costal) * cos(^(ir) * sinibt'j * sinpt) ^ cosi^gm) * cos(y77i))+ 

(^3 * cos{bt) * sin{al) * sin{bt) * cos{gm) * cos{gm))+ 

(^ ♦ sin{al) * sin[bt) * cos{gTn)) — i^zx * sin{aX) * sin{bt) * cosi^gm))] 

jac[ 3 ][l] = —( 2.0 *X3* cos{al) * cos{al) * cos{bt) * sin{bt))+ 

( 2.0 *ys* sin{al) * cos{al) * cos{bt) ♦ sin{bt))— 

{z3 * sin{bt) * sin{bt) * co 5 (oZ))+ 

(z3 * cos{bt) * cos{bt) * cos{al)) -{x* cos{al) * sin{bt))+ 

(xi * cos(al) * sin{bt)) — ( 2.0 * Z3* sin{bt) * sin{gm) * sm{al') * cos{gm))-\- 
( 2.0 *X3* cos{ar) * cos{al) * sm{bt) * cosipt) * sin(gm) * sm{gm))— 

(2.0 ♦ 2/3 ♦ cos{al) * sin{al) * sin{bt) * cos{bt) * sin{g'm) * sin{gm))+ 

{z3 * cospt) * cospt) * cos{al) * sin{gm) * sin{gm))- 
(zs * sin(bt) * sinpt) * cos{al) * sin{gm) * sin{gm))+ 

{y * sin{al) ♦ cos{bt) ♦ sin{gm)) - {yi ♦ sin{al) * cospt) * sin{gm))- 
( 2.0 * 373 * eos{d) * cos(aO * sinpt) * cospt) * cos{gm) * cos{gm)) 

—( 2.0 * ^3 * cos{al) * 8in{al) * sinpt) * cospt) ♦ cos{gm) * cos{gm))- 
(«3 ♦ cospt) * cospt) * cos{al) * cos{gm) * cos{gm))+ 

{z3 * sinpt) * sinpt) * cos{al) * cos{gm) * cos{gm))- 

(z * co8{al) * cospt) * cos{gm)) + {zi * cospl) * cospt) * cos{gm)); 

jac[ 3 ][ 2 ] = -( 2.0 * a :8 * sin{al) * sin{d) * cos{gm) * sin{gm))- 
( 2.0 *y3* sin{d) * cos{d) * cos{gm) * sin{gm))+ 

{2.0 * Z3 * cospt) * cos{gm) * cos{gm) * sinpl))- 
( 2.0 *Z3* cospt) * sin{gm) * sin{gm) * sin{d))- 
{y * sin{(il) * sin{gTn)) + {yi * sin{d) * sin{gTn))+ 

(2.0 *X3* cos{d) * cos{d) * sin{bt) * sin{bt) * sin{gm) * cos{gm))- 
( 2.0 ♦ 2/3 ♦ cosid) * sin{d) ♦ sm{bt) * sin{bt) * sin(gm) * cos{gm))+ 

{%.0 * Z3 ♦ cos{bt) ♦ sinpt) * cos{d) * sin{gm) * cos{gm))+ 

{y * co8{d) * sin{bt) * cosigm)) - {yi* cos(d) *sm(bt) *cos(gm))+ 

(2.0 * Xb * 3 in(d) * sm(d) * sin(gm) * cos(gm))+ 



( 2.0 *yz* cos{al) * sin{al) * sin{gm) * cos{gm))+ 

( 2.0 * zZ * cosibt) * costal) * s%n[ht') * cos[gm) * sin{gn%)')-\- 
{z * sin{al) * cos{gm)) — {zi * sin{al) ♦ cos[gm))— 

( 2.0 * X3 * cos(^cil) * cos{(it) * sin{bt) ♦ sin{bt) * cos^gm) * sin{gTn)')-\- 
( 2.0 * ys * cos{al) * sin{al) * sin{bt) * sin{bt) * cos{gm) * sin{gm))+ 

{z * cos{al) * sin{bt) * sin{gm)) - {zi * cos{al) * sin{bt) * sm(ym)); 

jac[3][3] = cos{al) *cos{bt); 

jac[3][4] = {sin{al) * cos(gm,)) + (^cos{al) * sin(bt) * sin{gm))‘, 
jac[3][5] = {sin{al) * sm(ym)) - {cos{al) * sin{bt) * cos{gm)); 

jac[4][0] = {x 2 — aJi) * {xz * {cos{al) * cos{gm) — sm(ai!) * sin{bt) * sin{gTn)) 

+yz * {-sin{al) * cx)s{gm) - cos{al) * sin{bt) * sin{gm))y, 
jac[4][l] = {x2 — aJi) ♦ ( 0:3 * {cos{al) * cos{bt) * sin(gm))+ 

Hz * {—sin{al) * cos{bt) * sin{gm)) + 2^3 * sin{bt) * sin{gm))’, 

jac[4][2] = {x2 — Xi) * {xz * {—sin{al) * sin{gm) + cos{al) * sin{bt) * cos{gm))+ 

yz * {—cos{al) * sin{gm) — sin{al) * sin{bt) * cos{gm)) - zz* cosipt) * cos{gm)); 

jac{4][3] = 0.0; 

jac[4][4] = ( 2:2 - xi); 

jac[4][5] = 0.0; 

jac[ 5 ][ 0 ] = (x 2 — Xi) * (x 3 ♦ {cos{al) ♦ sin{gm) + sin{al) * sin{bt) * cos{gm))+ 

yz * {sin{al) * 8in(gm) + cos{al) * sin{bt) * cos{gm))); 

jac[5][l] = (X2 - Xi) * (x3 ♦ {-cos{al) * sin{bt) * cos{gm))+ 

yz * {sin(al) * cos{bt) * cos(ym)) -zz* sin{bt) * cos{gm)); 

jac[ 5 ][ 2 ] = (X 2 - Xi) ♦ (X 3 ♦ {sin{d) * cos{gm) + cos{al) * sin{bt) * sin{gm))+ 

yz * {cos{al) ♦ cos{gm) — sin{al) ♦ sin{bt) * sin{gm)) + zz * cos{bt) * sm(ym)); 

jac[5][3] = 0.0; 

jac[5][4] = 0.0; 

jac[5][S] = (xa - xi); 

jac[ 6 ][ 0 ] = (X 2 - xi) * (X 4 * {cosial) * cos{gm) - sin{al) * sin{bt) * sm(yra)) 

-hy4 * {“-8in{(il) * cos{gTn) — cos{al) * sin{bt) * sin{gm)))', 

jac[ 6 ][l] = {x 2 -xi)*{x^* (cosial) * cos{bt)*sm^^ 

(—sin(al) * cos{bt) * sin{gm)) 4 - Z4 * sin(lft) * sin{gm))] 
jac[ 6 ][ 2 ] - (X 2 - xi) * (x 4 ♦ {-sin{<d) * sin{gm) + cosial) * sinipi) * cosigrr^+ 
y4 ♦ i-cosid) * sinigm) - sinial) * sinibt) * cosigm)) - Zi * ws(pi:)^^* 
jac[6][3] * 0.0; 





jac[6][4] = (x 2 - xi)] 
jac[6][5] = 0.0; 


jac[7][0] {x 2 a:i) * {x^, * (cos(al) * sin(gm) + sin(al) =)= sin(bt) * cos(gm))+ 

Va * {-sin{al) * sin{gm) + cos{al) * sin{ht) ♦ cos{gm)))\ 
jac[7][l] = {x 2 — x-i) * (x 4 * (—cos(al) * sin{bt) * cos{gm))+ 

Va * {sin{al) * cosibt) * cos{gm)) -za* sin{bt) * cosigm)); 

jac[7][2] = (x2 - xi) * (xa * isin{al) * cos{gm) + cos{al) * sin{bt) * sinigm))+ 

VA * {cosial) * cos{gm) - sin{al) * sin{bt) * sin{gm)) + ^4 * cosibt) * sinigm))-, 
jac[7][3] = 0.0; 

jac[7][4] = 0.0; 
jac[7][5] = {X 2 - Xi); 

jac[8][0] = 0.0; 
jac[8][l] = 0.0; 
jac[8][2] = 1.0; 
jac[8][3] = 0.0; 
jac[8][4] = 0.0; 
jac[8][5] = 0.0; 

/*** Residual vector ***/ 
resv[0][0] = {cosial) * cosibt) - 1.0); 

resv[l][0] = ((cos(aZ) * sinibt) * sinigm)) - {sinial) * (x>sigm)))-, 

re8v[2][0] == {{sinial) * sinigm)) - {cosial) * sinibt) * cosigm)))-, 

resv[3][0] = {(13 * cosial) * cosial) * cosibt) * cosibt))— 

iyz * sinial) * cosial) ♦ co5(6<) * cosibt)) + {za * cosial) + sinibt) * cos(6i))+ 

ix*cosial)*cosibt))-ixi*cosial)*cosibt))i-ix3*sinial)*sinial)*cosigm)*cosigm))- 

ipa * cosial) * sinial) * cosigm) * cosigm))+ 

(2.0 *Z3* cosibt) * sinigm) * sinial) * a)sigm))+ 

{y * sinial) * cosigm)) - iyi*3inicd) *cosigm))+ 

{xz * cosial) * cosial) * sinibt) * sinibt) ♦ sinigm) * sinigm))- 

iVs * cosial) * sinial) * sinigm) * sinigm) * sinibt) * sinibt))-jr 

{za * cosibt) * sinibt) * cosial) * sinigm) * sinigm))+ 

iy * cosial) * sinigm) * sinibt)) — {yi * cosial) * sinigm) * sinibt))-\- 

{xa * sinial) * sinial) * sinigm) * sinigm)) + (j/3 * cosial) * sinial) * sinigm) * sinigm))— 

iza*cosial)*sinigm)*cosibt)*cosigm)) + iz*sinial)*sinigm))— 

{zi * sinial) * sinigm))+ 

{xa * cosial) * cosial) * sinibt) * sin(fit) * cosigm) * cosigm))— 





(ys * cos{al) * sin{al) * sin{bt) * sm{U) * cos{gm) * cos(gm))- 

(za * cos(bt) * cos{ar) * sin{bt) * cos{gm) * cos{gm)) — {z* cos(aZ) * sin{bt) * cos{gm))-i- 

{zi * cos{ar) * sin{bt) * cos(gm))); 

resv[4][0] = (xa — Xi) * (xa * (sm(aZ) * cos{gm) + cos{al) * sin{bt) * sin{gm))+ 

Va * {cos{al) * cos{gm) — sm{al) * sin{bt) * sin{gm)) — Za* cos{bt) * sin{gm) + y — yi); 
resv[5][0] = {xa — xi) * (xa * (sm(a/) * sin{gm) — cos{al) * sinipt) * cos{grn))+ 
ya * {cos{al) * sin{gm) + sin{al) * sin{bt) * cos{gm)) -\-za* cosipt) * cos{gm) + z — Zi); 
resv[6][0] = (x 2 — xi) * {x^ * {sin{al) * cos{gm) + cos{al) * sin{bt) * sin{gm)) 

+y 4 * {cos{al) * cos{gm) — sm(ai!) * sin{bt) * sin{gm)) — Zi* cos{bt) * sin{gm) +y — yi); 
resv[7][0] = (x 2 — Xi) * (x 4 * {sm{al) * sin{gm) — cos{al) * sin{bt) * cos{g'm))+ 
y 4 * {cos{al) * sin{gm) + sin{al) * sin{bt) * cos{gm)) + 2:4 * cos{bt) * cos{gm) + z — Z])\ 
resv[8][0] = ym; 
break; 

case 2: /* * * Parallel to Y axis ***/ 

jac[0][0] = cos{ai) * cos{bt); /*** Jacobian Matrix ***/ 

jac[0][l] = —sin{al) *sin{bty, 

jac[0][2] = 0,0; 

jac[0][3] = 0.0; 

jac[0][4] = 0.0; 

jac[0][5] = 0.0; 

jac[l][0] = co8{al) ♦ sin{bt) * sin{gm) + sin{al) * cos{gm); 

jac[l][l] = sin{al) ♦ cos{bt) * sin{gm)] 

jac[l][2] = 8in{al) * sinipt) ♦ cos{gm) + cos{al) * sin[gmy 

jac[l][3] =:= 0.0; 

jac[l][4] = 0.0; 

jac[l][5] ~ 0.0; 

jac[2][0] = cos{al) * sin{bt) * co8{gm) - 8in{al) * sw(ym); 

iac[ 2 ][l] - sin(al) * ws(bt) * co8{grn); 

jac[2][2] = co8{al) * cos{gm) — sin{al) * sinipt) * sin{gm); 

jac[2][3] = 0.0; 

jac[2][4] = 0.0; 

jac[2][5] = 0.0; 

jac[3][0] = ^{xa*mn{al)*sin{aJ)*a)s{bt)*^c^^^^ 

(xg ♦ co8{al) * ws{al) * co8{bt) * cos{bt))— 



(2.0 * y, * sin{al) * cos{al) * cos{bt) * cos(bt)) + (zs * cos(al) * sin(bt) * cos(bt))- 
(xi * cos(al) * cos(bt)) + (2.0 *X 3 * sin(al) * cos(al) * sin(bt) * sin(gm) * cos(gm))+ 
(x 3 * cos{al) * cos{al) * sin{bt) ♦ sin{bt) * sin{gm) * sin{gm))- 
(X3 * sin{al) * sin{al) * sin{bt) * sm{U) * sm{gm) * sin{gm))~ 

(2.0 * yz* sin[al) * cos{al) * sin{bt) * sin{bt) * sin{gm) * sin{gm))— 

(Z 3 * cos(al) * sin{bt) * cos{bt) * sin{gm) * sin{gm)) - {y^ * cos{al) * sin{bt) * sin{gm))- 
{xz * cos{al) * cos{al) * cos{gm) * cos(gm)) + (x 3 *sm(al) * sm(al) *cos(gm) * cos(gm))+ 
(2.0 *X 3 * cos(al) * sin(al) * cos(gm) * sin(bt) * sin(gm))+ 

(2.0 *y 3 * cos{al) * sin{al) * cos{gm) * cos{gm))~ 

{Z 3 * 3in{al) * cos{gm) * cos{bt) * sin{gm)) + {y^ * sin{al) * cos(gm))- 

(a/3 * cos{al)*cos{al)*sin{gm)*sin{gm)) + {x 3 *sin{ar)*sin{at) *sin(gm)*sin{gm))— 

(2.0 * 0:3 * cos{al) * sin{al) * sin{gm) * sin{bt) * cos{gm))+ 

(2.0 *y 3 * cos{al) * sin{al) * sin{gm) * sin{gm))+ 

{zz * sin{al) * sin{gm) * cos{bt) * cos{gm)) - (zi * sin{al) * sin{gm))- 
(2.0 *X 3 * sin{al) * cos{al) ♦ sin{gm) * sin{bt) * cos{gm))+ 

{x 3 ♦ cosifll) * cos{al) ♦ sin{bt) ♦ sinibt) * cos{gm) * cos{gm))— 

{xz * sin{al) * sm(aZ) ♦ sin{bt) * sin{bt) * cos{gm) * cos{gm))— 

(2.0 *yz* sin{al) * cos{al) * sin{bt) ♦ sin{bt) * cos{gm) * cos{gm))— 

{zz * cos{bt) * co8{al) * sin{bt) * cos{gm) * cos{gm))+ 

{zi*cos{al)*sin{bt)*cos{gm))+{x*cos{al)*cos{bt))+{y*cos{ar)*sin{bt)*sin{gm))+ 
{y * sin{al) * (X>s{gm)) + (.z* sin{al) * sin{gm)) - (z* cos(al) * sin(bt) * cos(gm)); 

jac[3][l] =s —(2.0 *X 3 * co3(al) * sin(bt) * cos(bt) * sin(bt))+ 

(2.0 *yz* sin{al) * sm(al) ♦ cos(bt) * sin(bt}) + (zz * sin{al) * cos(bt) * cos(bt))— 

(zz ♦ 8in{al) * ain{bt) ♦ sin(bt)) + (xi * sin{al) * sin{bt))+ 

(xz * 8in(al) * sin(al) * eos(bt) * sin{gm) * cos(gim))-\- 
(3:3 * sin(al) * 8in(al) ♦ cos(bt) * 8in{gm) ♦ cos(gm))^ 

(2.0 *Xz* Hin{al) * C08{al) * 8in(bt) * (X)s(bt) * sin{gm) * sin(gm))- 
(2.0 * ijz * sinid) * 3in(d) * 8in{bt) * cos(bt) * sin{gm) * 8m{gm))- 
(zz ♦ 8in{d) * co8(bt) * cos{bt) * 8in{gm) * 8in{gm))+ 

(zz * sin{d) * 8in{bt) * 8in{bt) * sin{gTn) * 8in{g7n)) — (yi* 8in{al) * cos(bt) * 8in{gm))— 

{xz*cos{d)*cos(d)*co8(gm)*cos{bt)*sin{gm))— 

(zz * cos{al) * cos{gm) * 8in(bt) * sin{gTn))+ 

(xz * sin{al) * Mn(aO * 

(zz * cos(d) * sin{gm) * ms(grn) * 8in{bt))- 

(»3 * sin{al) * 8in{d) * 8in(gm) * co8{bt) * co8{gm))+ 

(2.0 N« X 3 * sin(d) * co8(d) * 8in{U)* cosibt) * cosisni) * cos{gm^- 
(2.0 *yz* sin(d) * 8in{d) ♦ 8in(bt) * cos(bt) * cos(gm) * cos{gm))+ 



(Z 3 * cos{bt) * cos{bt) * sin{al) * cos{gm) * cos(gm)) + (zi * sm(al) * cos(bt) * cos(gm))- 
(x * szn(al) * szn(bt)) + (y* sin(al) * cos(bt) * sin(gm)) - (z *sin(al) * cos(bt) * cos(gm)); 

jac[3][2] = ( 0:3 * sin(al) * sin(al) * sin(bt) * cos(gm) * cos(gm))- 
(xs * sin{(il) * sin^at) * sin(bt') * sin{gm) ’i' sw(p 7 Ti))+ 

( 2.0 * X 3 * 8in{al) * cos{al) * sin{bt) * sin{bt) * sin{gm) * cos{gm))- 
(2.0 *y 3 * 8in{al) * sin{al) * sin{bt) * sin{bt) * sin{gm) * cos{gm))- 

{^■Q*^3*si^{^^)*sin{bt)*cos{bt)*sin{gm)*cos(gm))—[yi*sin{al)*8in{bt)*cos{gm))+ 

(2.0 *X'i* sin{al) * cos{al) * cos{gm) * sin{gm))- 
{x-i * cos{al) * cos{al) * cos{gm) * cos{gm) * sin{bt))+ 

{xs * cos{al) * cos{al) * sin{gm) * sin{gm) * sin{bt))+ 

( 1/3 * cos{al) * cos{al) * cos{gm) * sin{gm)) + ( 2:3 * cos{al) * cos{gm) * co8{gm) * cos{bt)) — 
(z 3 * eos{al) * cos{bt) * sm{gm) * sin{gm)) + {yi ♦ cos{al) * sin{gm))- 
(a ;3 * sin{al) * cos{ar) * sin{gm) * cos{gm))+ 

(xs * cos{al) * cos{al) * cos{gm) * cos{gm) * cos{bt))- 
(x 3 * cos(al) * cos{al) * sin{gm) * sin{gm) * 8in{ht))- 
(2.0 * 1/3 ♦ cos{al) * cos{al) * sin{gm) * cos{gm))- 
{zz ♦ cos{al) ♦ cos{gm) ♦ co8{gm) * cos{bt))+ 

{zz * cos{ai) * sin{gm) * 8in{gm) * cos{bt)) + {zi * cos{al) * cos{gm))- 
{xz * sin{al) ♦ sin{al) * cos{gm) * cos{gm) * sin{bt))+ 

{xz * 8in{al) * sin{al) * 8in{gm) * sin{gm) * sin{bt))— 

( 2.0 ♦ X 3 * 8in{al) ♦ cos{al) * sm( 6 f) * sin{bt) * cos{gm) * sin{gm))+ 

(2.0 ♦ yz * sin{al) * sin{al) * 8in{bt) * 8in{bt) * cos{gm) * sin{gm))+ 

(2.0 *zz* cos{bt) * 8m{al) ♦ 8in{bt) * cos{gm) * sin{gm))- 

{zi * ain{al) ♦ 8in{bt) ♦ sin{gm)) + {y* 8in{al) * sin{bt) * cos{gm))+ 

(y ♦ cos(ol} * 8in(gm)) - {z* cos{al) * co8{gm)) + {z* 8in{al) * sin{bt) * sm(pm)); 

jac[3][3] = mn{al) * coa(W); 

jac[3][4) = 8in{al) * sin{bt) * sm{gm) - co8{d) * co8{gmy, 
i(ic[3][ri]^ --cos{d)*sin{gm)-8in{d)*sin{U)*cos{grny, 

jac[4][()] = ivi - yi) * (-x3 ♦ sin{d) * cos(6i) - y3 * cos{d) * cos(6t)); 

jac[4][l] — iVi-yi) * (“2:3 * cos{d) * sin{bt) + y3 * 8in{d) * 8in{bt) + zZ * cos{bt)); 

jac[4|[2] = 0.0; 
jac[4][3j = (ya-l/i); 
jac[4]{4} *0.0; 

jac[4][5] * 0.0; * ^ ' 



jac[5][0] = (^2 — Vi) * {xz * {cos{al) * sin{gm) + sin{al) * sin{bt) * cos{gm))+ 
yz * (cos(al) * sin(bt) ♦ cos(gm) - sin(al) * sin(gm))); 
jac[5][l] = (y2 — yi) * (^3 * (—cos(al) * cos(bf) * cos{gm)) + yz* {sin{al)* 
cos{bt) * cos{gm)) - zz* sin{bt) * cos{gm)); 

jac[5][2] = (2/2 — yi) * {xz * {sin{al) * cos{gm) + cos{al) * sin{bt) * sin{gm))+ 
yz * {cos{al) * cos{gm) — sin{al) * sin{bt) ♦ sin{gm)) — Zz * cos{bt) * sin{gm))\ 
jac[5][3] = 0.0; 
jac[5][4] = 0.0; 
jac[5][5] = (y 2 -yi); 

jac[6][0] = (2/2 - yi) * {—Xi * sin{ar) * cos{bt) -y^* cos{al) * cos(6i)); 

jac[6][l] = (y2 “ yi) * (— 3^4 * cos{at) * sin{bt) +yi* sin{al) * sin{bt) + z^* cos{bt)) 

jac[6][2] = 0.0; 

jac[6][3] = (^2 - 2 /i); 
jac[6][4] = 0.0; 
jac[6][5] = 0.0; 

jac[7][0] = (2/2 — yi) * {xa * {cos{al) * sm{gm) + sw(oZ) * sin{bt) * cos{gm))+ 
yi ♦ {cos{al) * sin{bt) * cos{gm) - sin{al) * sin{gm))); 
jac[7][l] = (^2 - Vi) * (a :4 * {-cos{al) * cos{bt) * cos{gm)) + j/4 * {sin{al)* 
cos{bt) * cos{gm)) — Za* sin{bt) * cos{gm))‘, 

jac[7][2] = (y2 - yi) * {xi * {sin{al) * cos{gm) + cos{ar) * sin{bt) * sin{gm))+ 
yA * {cos{al) * cos{gm) — sin{al) * sin{bt) ♦ sin{gm)) — za* cos{bt) * sin{gm))] 
jac[7][3] = 0.0; 
jac[7][4] := 0.0; 
jac[7][5] = {y2 - yi)\ 

jac[8][0] = 0.0; 
jac[8][l] = 1.0; 
jac[8][2] = 0.0; 
jac[8][3] = 0.0; 
jac[8][4] = 0.0; 
jac[8][5] = 0.0; 

f** * Residual vector ***f 

resv[0] [0] = sw(a/) *cos(&i); 

resv[l][0] = ((sin(aZ) * 5in(&e) ♦ sw(gm)) - (cos(aO * cosW) 

resv[2][0] = {{cos{ai)*sin{gin)) + {sm{al)*sin{bt}* 



case 3 : 


resv[ 3 ][ 0 ] = {{x^ * cos{al) * sin{al) * cos{bt) * cos{bt))— 

{Vs * sin{al) * sin{al) * cos(bt) * cos(bt)) + (^3 * sin{al) * sin(bt) * cos(bt))— 

(xi * sin{al) * cos(bt)) + (xa * sin{al) * sin{al) * sin{bt) * sin{gm) * cos{gm))+ 

(xa * sini^al) * cos{pX) * sin{bi) * sin{bt) * sin{gTn) * sin{g7Ti)')— 

{Vz * sin{al) * sin{al) * sin{bt) * sm[bt) * sin[gm) * sin{gm))- 

{zz * sin(al) * sin{bt) * cos{bt) * sin{gm) * sin{gm)) - {y^ * sin{al) * sin{U) * sin{gm))- 

(xa * sin{al) * cos{al) ♦ cos{gm) * cos{gm))- 

(xa * cos{al) * cos{al) * cos(gm) * sin{bt) ♦ sin{gm))- 

{yz * cos{al) * cos{al) * cos{gm) * cos{gm))+ 

{zz * cos{al) * cos(gm) * cos{bt) * sin{gm))+ 

(yi + cos{al) * cos{gm)) — (xa * sin{al) * cos{al) * sin{gm) * sin{gm))+ 

{xz * cos{al) * cos{al) * sin{gm) * sin{bt) * cos{gm))- 

{yz * cos{al) * cos{al) * sin{gm) * sin{gm)) + {zi * cos{al) * sin{gm))- 

(xa * sin{al) * sin{al) * sin{gm) * sin{bt) * cos{gm))-\- 

{xz * sm(ai!) * cos{al) * sin{bt) * sin{bt) * cos{gm) * cos{gm))— 

{yz * sin{al) * sinial) * sin(bt) * sin{bt) * cos(gm) * cos(gm))— 

(zz * cos{bt) * 5m(af) ♦ sin{bt) ♦ cos{gm) * cos{gm)) + {zi * sin{al) * sin{bt) * cos(gm))+ 
(x * sin{al) ♦ cos{bt)) + {y* sin{al) * sin{bt) * sin{gTn)) — {y* cos{al) * cos(gm))— 

{z * cos{al) * sin{gm)) — {z* sin{al) * sin{bt) * cos{gm))y, 

res v[ 4 ] [ 0 ] = {y2 — yi)* (®3 *cos{al)*cos{bt) — yz* sin (at)* cos (bt) +zz* sin{bt) +x—xi)i 
resv[ 5 ][ 0 ] = {yz — yi) * (xz * (sin(al) * sin(gm) - cos(al) * sm(bt) * cos(gm))+ 
yz * {cos{al) * sin{gm) + sin{al) * sin{bt) * cos{gm)) + 2:a * cos{bt) * cos{gm) + z- zi); 
resv[6] [ 0 ] = (^2 ■“ yi) * (®4 * cos{al) *cos{bt) - y4*sin{al) * cos{bt)+Z4 * sin{bt) +x—xi)', 
r^v[7]{0] = (y2 ~ Vi) * (^^4 * {sin{al) * sin{gm) - cos{al) ♦ sin{bt) * cos{gm))+ 
y4 ♦ (co5(oi!) * sin{gm) + sin{al) * sin{U) * cos{gm)) + Z4* cos{bt) * cos{gm) + z — zi); 
resv[8][0] - bt; 
break; 

/♦ ♦ ♦ Parallel to Z axis ***/ 
jac[ 0 ][ 0 ] ss 0 . 0 ; /*** Jacobian Matrix ***/ 

jac[0][l] == cos{bt); 
jac[0][2] = 0.0; 
jac[ 0 ][ 3 ] = 0 . 0 ; 
jac[ 0 ][ 4 ] = 0 . 0 ; 
jac[ 0 ][ 5 ] =: 0 . 0 ; 

jac[l][0] == 0.0; 

jac[l][l] == ♦ sw(ffm); 
jac[l] [2] = cos(6i) *co5(j9'm); 



jac[l][3] = 0.0; 
jac[l][4] = 0.0; 
jac[l][5] = 0.0; 


jac[2][0] = 0.0; 

jac[2][l] = —sin(bt) *cos{gm)\ 
jac[2][2] = ~cos{bt) * sin{gm)] 
jac[2][3] = 0.0; 
jac[2][4] = 0.0; 
jac[2][5] = 0.0; 

jac[3][0] = (0:3 * sin{al) * cos{bt) * sin{bt)) + {y^ * cos{al) * cosQrt) * sin{bt))— 
{xs * sin{al) * sin{bt) * sin{gm) ♦ sin{gm) * cos{bt))- 
{yz * cos{ar) * sin{bt) * cos{bt) * sin{gm) * sm{gm))- 
(xz * sin(al) * sin{bt) * cos{gm) * cos{gm) * cos{bt))— 

{yz * co${al) * sin{bt) * cos(gm) * cos{gm) * cos{bt)y, 

jac[3][l] = (2:3 ♦ cos{al) * sin{bt) * sin{bt)) - {xz * cos{al) * cos{bt) * cos{bt))+ 
{yz * sin{al) * cos{bt) * cos{bt)) — {yz * sin{al) * sin{bt) * sin{bt))— 

(2.0 * ^3 ♦ 3in{bt) * cos{bt)) — {x* cos{bt)) + (a;i * cos(6t))+ 

{xz * cos{al) * cos{bt) * cos{bt) * sin{gm) * sin{gm))- 
{xz * cos{al) ♦ sin{bt) * sin{bt) * sin{gm) * sin{gm))— 

{yz * sm(ai) * cos{bt) * cos{bt) * sin{gm) * sin{gm))+ 

{yz * 8in{al) * sin{bt) * sin{bt) * sin{gm) * sin{gm))— 

(2.0 ♦ -Za * cos{bt) * 8in{bt) * sin{gm) * sin{gm))- 
{y * 8in{bt) * sin{gm)) + {yi * sin{bt) * 8in{gm))+ 

{xz * cos{ar) * co8{bt) * co8{bt) * cos{gm) * cos{gm))- 
{xz*cos{al)*sin{bt)*sin{bt)*co8{gm)*cos{gm))- 
{yz * sin{al) * eo8{bt) * cos{bt) * co8{gm) * cos{gm))+ 

{yz * sin{al) * 8in{bt) * 8in{bt) * cos{gm) * cos{gm))-\- 

(2.0 *zz* cos{gm) * co8{gm) * co8{bt) * sm(6i)) + (2; * sin{bt) * cos{g7n))- 

{zx * sin{bt) * cos{gm)); 

jac[3] [2] = (2.0 *yz* sin{al) * 8in{bt) * cos{bt) * sin{gm) * cos{ym)}+ 

(2.0 *zz* cos{bt) * cos{bt) * sin{gm) * cos{gm))+ 

{y * co8{bt) * eo8{gm)) ~ {yi * cos{bt) * cos{grn))+ 

(2.0 *yz* sin{al) * 8in{bt) * co8{bt) * cos{gm) * sin{gm))+ 

(2.0 *zz* cos{U) ♦ cos{U) ♦ co8{gm) * sin{gm))+ 

ne\ 



{z * cos{bt) * sin{gm)) - {zi * cos{bt) * sin{gm)y, 

jac[3][3] = —sin{bt)-, 
jac[3][4] = cos{bt) ^sin{gm)\ 
jac[3][5] = -cos{bt) * cos{gm)-, 

jac[4][0] = ( 2:2 — Zi) * (— aj 3 * sin[al) * cos{bt) — 2/3 * costal) * cos(bty)\ 

jac[4][l] = ( 2^2 — Zi) * {—Xz * cos(al) * sin(bt) + 2/3 * sin{al) * sin(bt) + Zz* cos{bt))] 

jac[4][2] = 0.0; 

jac[4][3] = {z 2 - Zi)] 
jac[4][4] = 0.0; 
jac[4][5] = 0.0; 

jac[5][0] = {z 2 — zi) ♦ (xz * {cos{al) ♦ cos{gm) — sin{al) * sin{bt) * sin{gm))+ 
yz * {—sin{al) * cos{gm) — cos{al) * sin{bt) * sin{gm)))\ 
jac[5][l] = {z 2 — Zi) * (xz * (cos(al) * cos{bt) * sin(gm))+ 

2/3 * {—sin{al) * cos{bt) * sin{gm)) — zz* sin{bt) * sin{gm)); 

jac[5][2] = {z 2 — Zi) * ( 2:3 * {—sin{al) * sin{gm) + cos{al) * sin{bt) * cos{gm))+ 

yz * {—cos{al) * sin{gm) — sin{al) * sinibt) * cos{gm)) + zz* cos{bt) * cos{gm)); 

jac[5][3] = 0.0; 

jac[5][4] = {Z 2 - zi); 

jac(5][5] = 0.0; 

jac{6][0] = (22 - Zi) * (-X 4 ♦ 8 in(al) ♦ cos(bt) - 2/4 * cos(al) * cos(bt)); 

jac[6][l] = (^2 - Zi) ♦ (-X 4 * cos(al) * sin(bt) + 2/4 * sin(al) * sin{bt) + Z 4 * cos{bt))-, 

jac[6][2] = 0.0; 

jac[6][3] - 2 !i); 

jac[6][4] = 0.0; 

ja«[6]i5) = 0.0; 

jac[7][0] -{Z 2 - zi) ♦ (*4 * {cos{al) * cos{gm) - sin{al) * sin{bt) * sm(pm))+ 

y 4 *{-sin{al)*cos{gm) — cos{al)*sin{bt)*sin{gm)))-y 
jac[7][l] = {z 2 - Zi)*{x 4 *{cos{al)*ws(U)*sin{gm))+ 

y^*{--sin{d)*cos{bt)*sin{gm))-Z4*sin{bt)*sin{gm)y, 

jac[7][2] s= (z2 “ ^1) * (®4 * {—sin{al) * sin(gm) + cos{al) * * cos( 5 Tn))^- 

J /4 ♦ {-cos{al) * 8in{gm) - 8m{al) * 8in{U) * co8{gm)) + 2^4 * cos( 6 i) * cosM); 

jac[7][3] = 0.0; 
jac[7][4] = iz 2 -zi)y 



jac[ 7 ][ 5 ] = 0 . 0 ; 


jac[8][0] = 1.0; 
jac[8][l] = 0.0; 
jac[8][2] = 0.0; 
jac[ 8 ][ 3 ] = 0 . 0 ; 
jac[ 8 ][ 4 ] = 0 . 0 ; 
jac[ 8 ][ 5 ] = 0 . 0 ; 

/* * * residual vector ***/ 
resv[0][0] = s%n{bt)\ 
resv[l][0] = cos{bt) * 8 in{gm)] 
resv[2][0] = (cos(bt) * cos(gm) - 1); 

resv[ 3 ][ 0 ] = (—(xs * cos(al) * cos(bt) ♦ sin{bt)) + (^3 * sin{ar) * cos{bt) * sin{bt)) - 
{zb * sin{bt) * sin{bt)) - {x* sin{bt)) + {xi * sin{bt))+ 

(sg ♦ cos{al) * sin{bt) * sin{gm) * cos{bt) * sin{gm))- 
(^3 ♦ sin{al) * sin{bt) * sin{gm) *■ sin{gm) * cos{bt))+ 

{^3 * cos{bt) * co 8 {M) * sin{gm) * sin{gm)) + {y* cos{bt) * sin{gm))- 
{yi * eos{bt) * sin{gm))- 

{xs * cos(al) * sin(bt) * cos(gm) * cos(gm) * cos(bt))~ 

{y% * sin(al) * sin(bt) * cos(gm) * cos(gm) * cos(bt))- 

(Z3 * cos(bt) ★ cos(bt) ♦ cos{gm) ♦ cos{gm)) - (z * cos{bt) * cos{gm))+ 

(zj * co 8 {bt) * cosigm))); 

re8v[4] [ 0 ] =5 {z 2 — Zi)* (X 3 ♦ cos(al) * cos(bt) —pa* sin(al) * cos{bt) + Z 3 ♦ sin{bt) -\-x—xx ) ; 
re8v[5][0] = {z% — zi) * (xa ♦ {sin{(d) * cos{gm) + cos{ar} * sin{bt) * sin{gm))+ 

1/3 ♦ {cosid) * cos(gm) - sm(d) * sin(bt) * sm(gm)) + Z3* cos(bt) * sm(gm) + y -yi); 
resv[6][0] = 

re8v[7][0] a® (za *“ zi) * (a ;4 * {sin{(d) * cos{gm) 4- cos{al) * sin{bt) * sin{gm))+ 

Pi ♦ (couid) ♦ cos(gm) - sin(al) * sm(bt) ♦ sin(gTn)) + Z4 * cos(bt) * szn(gm) + y -yx)\ 

re8v[8][0] = d\ 

breaJk; 

1 : ; : • 

!*** Least Square Approach***! 
for(i ~ 0; i < 6; i + +) 
for(j =:0;i < 9;i + +) 
trjac[i]\j] ^ jacy]\i]; 



Calling Functions ** */ 

inatmul(6, 9, 6 , ktrjac[0] [0], &jac[0][0], kprotrjac[0][0]y, 
matinv(6, 6 , kprotrjac[Q][Q],kinvprotrjac[ 0 ][ 0 ]y, 
matmul(6, 6, 9, kinvprotrjac[Q][0], &:trjoc[0][0], &s/pro[0][0]); 
matmul(6, 9, 1, kslpro[0][0y &rest;[0][0], &/pro[0][0]); 

if((a:i > 0&&:a:3 > 0)kk{yi > Okkys > 0)kk(zi > Okkzs > 0)) 

{ 

= /pro[3][0]; *ty = /pro[4][0]; = fpro[5][0]] 

} 

else 

{ 

*tx = -/?>7'o[3][0]; *ty = -fpro[4][0]\ = -/pro[5][0]; 

} 

} 

/** * Algorithm for the case where the component is inclined to two of the planes and 
parallel to one plane* **/ 

GLfioat xpjacnresv( GLint s, GLfloat *pii, GLfloat *p 22 , GLfloat *p 33 , GLfloat *pu, 
GLfloat *tx, GLfloat *ty, GLfloat *tz ) 

{ 

GLfloat nbx, nhy, nbz, nrx, nry, nrz; 

/** * Normals of the two inclined mating faces* * */ 
nrx = cos(15 * m); nbx — -cos(15 * m); 

nry = -sm(15 * m); nby = sm(15 ♦ m); 

nra?~0.0; nbz = 0,0] 

for(i sa 0; i < 3; i + +) 

{ 

pi[*] = *Pii;*Pn + +; 

P 2 [i] = *pn;*P22 + +', 

PaM = ♦Psaj *jP33 + +r 

P 4 [i] = ♦P44; *P 44 + +; 

xi=Pi[0]]yi=Pi[l]]Zi-Pi[% 

a;2 » Pa[0]; P2 = P2[l]; ^ = P2[2]; 



{ 

Xz = P3[0]; Vz = P3[l]; 2:3 = P3[2]; 
a;4 = p4[0]; Va ~ P4[l]; Z 4 = p4[2]; 

} 

else 

{ 

2:3 = P4[0]; vz = P4[l]; 2:3 = p4[2]; 
xa = P3[0]; ?/4 = P3[l]; 2:4 = P3[2]; 

} 

X = 0.0; y = 0.0; z = 0.0; 

gamma = 0.0; beta = 0.0; alpha = 0.0; 


gm = {PI * gamma) /iSO.O] 
bt = {PI * beta) /180,0; 
al = (PI * alpha)/ 180. 0] 

/* * * Jacobian Matrix* **/ 

jac[0][0] = — (nra;) ♦ sin{al) * cos{bt) — (nry) * cos{al) * cos{bt)’, 

jac[0][l] = —{nrx) * cos{al) * sin{bt) + {nry) * sin{al) * sm(6i); 

jac[0][2] = 0.0; 

jac[0][3] = 0.0; 

jac[oi[4] = 0.0; 

jac[0][5] * 0.0; 

jac[l][0] as {nrx) * {co8{al) * sin{gm) + sin{al) ♦ sin{bt) * cos{gm))+ 

{nry) * {-sin{al) * co8{gm) - cos{al) * sin{bt) * sin{gm)); 

jac[l][l) = (nra) * {co8{al)*cos{bt)*sin{gm)) + {nry) * {-sin{al)*cos{bt)*sin{gm)) 
{ 7 irx) * {■~sin{al) * 8in{gm) + cos{al) * sin{bt) * cos{gm))+ 

{nry) * {—co8{al) * 8in{gm) — sin{al) * sin{bt) * cos/gm)); 
ja€[l]{3] = 0.0; 
jac{l][4] * 0.0; 
jac[l]{5] = 0.0; 

jac[2][0] = {nrx) * {cos{al) * sin{gm) + sin{al) * sinipi) * cos{gm))^ 

{nry) * {—sin{al) * sin{gm) 4- cos{al) * sin{bt) * cos{gm))‘, 

jac[2](l] = {nrx) * {cos{al) * cos{bt) * cos{gm)) + {nry) * {sin{aX) * cos(6t) * cos{grn/) 

ia 42 p\^ {nrx)*{8m{al)*cos{gm) + cos{al)*sin{bt)*sin{gm))+ 



{nry) * {cos{ai) * cos{gm) - sin{al) * sin{ht) * sin{gm))-, 
jac[2][3] = 0.0; 
jac[2][4] = 0.0; 
jac[2][5] = 0.0; 

jac[3] [0] = -yz * (nrx) * W8{al) * cos{al) * cos{bt) * cos(bt) - 

xz * (nry) * cos{al) * cos{al) * cos{U) * cos{bt) -xi* (nry) * cos{al) * cos{U)+ 

yz * (nra;) * cos{al) * co8{al) * cos{gm) * co8{gm) -y^* (nrx) * cos{al) * cos{gm)+ 

xz * {nry) * cos{al) * cos{al) * co8{gm) * co8{gmy, 

jac[3][l] = zz* [nrx) * co8{al) * cos{bt) * co8{bt)- 

zz * {nrx) * cos{bt) =« cos{bt) * cos{al) * co8{gm) * co8{gm)+ 

Zi ♦ {nrx) * cos{al) * cos{bt) * co8{gm)] 

jac[3][2] = -2;3 ♦ (nry) * co8{bt) + cos{gm) * co8{gm) * co8{al)+ 

Zz ♦ (nry) * co3{bt) ♦ co8{gm) * cos{gm) * co8{al) -Zi* (nry) * co8{al) * cos{gm)] 

jac[3][3] = (nrx) + cos{al) * co8{bt) + (nry) * sm{al) * cos(6i); 

jac[3][4] = {nrx) * sin{al) * cos{gm) + {nrx) * cos{al) * 8in{bt) * 8in{gm)+ 

{nry) * cos{al) ♦ cos{gm) - {nry) * sin{al) * sin{bt) * 8m{gm)-, 
jac[3][5] = (nrs) ♦ sin{al) * sin{gm) — {nrx) * cos{al) ♦ 8in{bt) * cos{gm)+ 

{nry) * C08{ai) * sin{gm) + (nry) * 8in{al) * sin{bt) * cos{gm)\ 

jac[4](0] ” (xa -■ Xi) * (xa ♦ {cos{al) * 8in{gm) + 8in{al) * 8in{bt) * co8{gm)) 

+yz * {"~sin{al) * 8in{gm) + cos{d) * sin{bt) * cos{gm))y, 
jac[4]{l] s= (23 - xi) * (xg * {'•■cos{al) * cos{bt) * cos(ym)) 

+y3 ♦ (sin(aO * cos{bt) ♦ co8{gm)) - Zz * 8in{bt) * co8{gm)y, 

jac[4|[2] as (X'i - Xj) * (X3 ♦ {8in{al) * cos{gm) + cos{al) * 8in{bt) * 8in{gTn)) 

+yz * {cos{al) * m8{gm) - 8in{cU) * 8in{bt) * 8in{gm)) - zz * co8{bt) * sin{gm)); 
Jac[4][3] « 0.0; 
jac[4][4l * 0.0; 
ja«(4][5] « (xa~xi); 

jac[5][0] * (ya “■ !/i) * * {(x>8{al) * sin{gni) + sin{al) * sin{bt) * cos{gm)) 

+yz * {—sin{al) * sin{gm) + co8{(d) * sin{bt) * cos{gm))); 
jac(5][l] = (ya - yO ♦ (X3 ♦ (-cos(aO ♦ cos{6i) * co5(ym)) 

+^3 * {Mn{al) * cos{bt) * cos{gm)) -zz* sin{bt) * cos{gm)); 

jac[5][2] = (1/2 ~ yi) ♦ (X3 * {sm{d) * cos{gm) + cos{al) * sin{bt) * sin{gm)) 

+yz * {cos{al) * cos{gm) - sin{al) * sin{bt) * sin{gm)) -zz* cos{bt) * szn(ym)); 

jw[5][3] « 0.0; 
jac{5][4j *0.0; 



jac[5][5] — (^2 - 2/i); 


jac[6][0] = {x^ — Xi) * (xs * (cos(oZ) * cos{gm) — sin{al) * sin{bt) * sin{gm)) 

+2/3 * {—sin{al) * cos{gm) — cos{al) * sin{bt) * sin{gm))) 

~{y2 ~ Vi) * (—3^3 * sin{aX) * cos{bt) — yS* cos{al) * cos(bt))i 

jac[6][l] = {x2—Xi)*{x3*(cos{al)*cos{bt)*sin[gm))+yz*{—sin(al)*cos{bt)*sin(gm)) 

+Z3 * sin{bt) * sin{gm)) — (y2 — yi) * (— X3 * cos{al) =1= sin{bt)+ 

2/3 * sin{al) * sin{bt) + 23 ♦ cos{bt))-, 

jac[6][2] = (x2 - xi) * (x3 * {—sin{al) * sin{gm) + cos(al) * sin{bt) * cos(gm)) 

+2/3 * {—cos{al) * sin{gm) — sin{al) * sinibt) * cos{gm)) — z^* cos{bt) * cos{gTn)); 

jac[ 6 ][ 3 ] = (t/s - 2/1); 
jac[ 6 ][ 4 ] = (x2 - xi); 
jac[ 6 ][ 5 ] = 0 . 0 ; 

jac[ 7 ][ 0 ] = (x2 — a:i) * (x4 * {cos{al) * sin{gm) + sin{al) * sin{bt) * cos{gm)) 

+ 2/4 * (— 5 in(a/) * sin{gm) + cos{al) * sin{bt) * cos{gm)))-, 
jac[ 7 ][l] = (x2 — Xi) * (x4 ♦ (—cos{al) * cos{bt) * cos(gm)) 

+y4 * {sin{al) * cos{bt) * cos{gm)) ~ Zi* sin{bt) * cos{gm))', 

jiac[ 7 ][ 2 ] = (x2 — Xi) * (x4 * {sin{al) * cos{gm) + cos(a/) * sin{bt) * sin{gm)) 

+y4 ♦ {cos{ar) * co8{gm) — sin{al) * sin{bt) * sin{gm)) — 2:4 * cos{bt) * sm(ym)); 
jac[ 7 ][ 3 ] = 0 . 0 ; 
jac[ 7 ][ 4 ] = 0 . 0 ; 
jac[ 7 ][ 5 ] = (X2 - xi); 

jac[ 8 ][ 0 ] = (2/2 - 2/1) * (^4 * {cos{al) * sin{gm) + sin{al) * sin{bt) * cos{gm)) 

+y4 ♦ (— sin(ai) * sin{gm) + cos{al) * sin{bt) * cos{gm)))', 

jac[8][l]- {y2-yi)*ix4*{-cos{d)*cos{bt) *cos{gm)) 

+ 2/4 * {sin{al) ♦ co8{bt) * cos(ym)) - 24 * 8in{bt) * co8{gTn)y, 

jac[ 8 ][ 2 ] = (2/2 - 2/1) * (®4 * {sin{al) * cos{gm) + co8{al) * sin{bt) * 8in{gm)) 

+2/4 * (cos(al) * co8{gm) — 8in{al) * 8in{bt) * 8in{gm)) — Z4 * cos{bt) * sin{grn))\ 
jac[ 8 ][ 3 ] = 0 . 0 ; 
jac[ 8 ][ 4 ] = 0 . 0 ; 
jac[ 8 ][ 5 ] = (y2 - 2/1); 

jac[ 9 ][ 0 ] = (X2 - xi) ♦ (X4 * {cos{al) * cos{gm)- 8in{at} * sm(&i) ♦ sm(y 7 n)) 

+y4 ♦ {-8in{al) * co8{gm) - co8{al) * 8in{bt) * 5 in( 5 m)))- 
4c (— X4 ♦ sin{al) * cos{bt) — 2/4 * co8{al) * cos(bt)); 
jac[ 9 ] [ 1 ] = (X2 - xi) ♦ (x4 * (co8(al) * cos(bt) * sm(ym)) 



+y 4 * i-sin{al) * cos{U) * sin{gm)) -z^* sin{bt) * sinigm)) - 

(y2 — Vi) * (—2:4 * cos{al) * sin{bt) — y^* sin{al) * sin{bt) + Z4* cos(bt)); 

jac[9][2] (x2 Xi) * (x4 ♦ (~sin(cd) ♦ sin(gm) + cos(al) * sin(bt) * cos(gTn)) 

+y4 * (-cos(al) * sin(gm) - sin(al) * sm(bt) * cos(gm)) +Z4* cos(bt) * cos(gm)): 

jac[9][3] = (y2-y0; 

jac[9][4] = (x2 - xi); 
jac[9][5] = 0.0; 

jac[10][0] = 0.0; 
jac[10][l] = 0.0; 
jac[10][2] = 1.0; 
jac[10][3] = 0.0; 
jac[10][4] = 0.0; 
jac[10][5] = 0.0; 

/* * * Residual Vector* **/ 

res'v[0][0] = (nrx) * cos{al) * cos{bt) — (nry) * sin{al) * cos{bt) + nbx; 

resv[l][0] = {nrx) * (sin{al) * cos{gm) + cos{al) * sin{bt) * sin{gm))+ 

[nry] * (cos(a^) * co8{gm) - sin{al) ♦ sin{bt) * sin{gm)) + nby; 

resv[2][0] = (nrx) * [sin{al) * sin{gm) — cos{al) * sin{ht) * cos{gm))+ 

(nry) * {cos{al) * sin{gm) + sin(al) * sin{bt) * cos{gm)) + nbz; 

resv[ 3 ][ 0 ] = X3 * (nrx) * cos(a/) * cos(o^) * cos(&t) * cos(&i)— 

Xi * (nrx) * C 08 {al) * cos{bt)+ 

y$ * (nry) * cos{al) * cos{al) * cos{gm)* cos{gm) -yi* (nry) * ws{al) * cos{gm)-, 

rav[4][0] — (x2 ”• Xi) * (x3 * {sin{al) * sin{gm) - cos{al) * sin{bt) * cos{gm)) 

+2/3 * {cos{al) * sin{gw) + sin{al) * sin{bit) * cos{gm)) + Z3* cos{bt) * cos{gm) + z — zi); 

resv[5] [0] = (j/2 - yi) * {xs * isin{al) * sin{gm) - cos{al) ♦ sin{bi) * cos{gm)) 

+1/3 * (cos(aZ) ♦ sin(gm) + sin{al) *sin{bt) * cos{gm)) + Z3 *cos{bt)* cos{gm) z — zi)', 

resv[6][0] = (x2 — aJi) * (xs * (sin(al) * cos(gm) cos(al) * sin(bt) * sin(gm)) 

+y3*(cos(al)*cos(gTn) — sin(al)*sin(bt)*sin(gm)) — Z 3 *cos(bt)*sin(gm)+y — yi)— 

(y2 “ 2/1) * (^3 * cos(al) * cos(bt) — ys * sm(al) * cos(bt) + Z3 * sm(bt) + x — xi); 



resv[7][0] ( 0:2 Xi) * (x 4 * (sin(cil) ♦ sin(gm) — cos(a,t) ♦ sin{bt) * cos{gm)) 

+y4 * {cos{ar) * sin{gm) + sin{al) * sin{bt) * cos{gm)) + Z4* cos{bt) *cos(gm) + z — zi); 

resv[ 8 ][ 0 ] = (jt /2 — Vi) * {xi * {sin{al) * sin(gm) - cos( at) * sin{bt) * cos{gm)) 

+y4 * {cos{al) * sin{gm) + sin{al) * sin{bt) * cos(gm)) + Z4* cos{bt) * cos{gm) + z — zi); 

resv[9][0] = (x2 — Xi) * ( 0:4 * (sm(aZ) * cos{gm) + cos(al) * sin{bt) * sin{gm)) 

+y4 * {cos{a() * cos{gm) — sin{al) * sin{bt) * sin{gm)) + Z4* cos{bt) * sin{gm) + y — yi)— 
(?/2 ~ yi) * ( 3^4 * cos{al) * cos{bt) — 7/4 * sin{al) * cosipt) Z4* sin{bt) + x — a^i); 

resv[ 10 ][ 0 ] = gm; 

for(i = 0; i < 6; t + +) 
for(i = 0;j < 9;j + 4-) 
trjac[i][j] =jac\j][i]; 

matmiil( 6 , 9, 6 , &trjac[ 0 ][ 0 ], &:jac[ 0 ][ 0 ], kprotrjac[0][Q]); 
matinv( 6 , 6, kprotrjac[0]l0],kinvprotrjac[0][0]y, 
matmul( 6 , 6 , 9, kinvprotrjac[0][0],ktrjac[0][0], &:s/pro[ 0 ][ 0 ]); 
matmul( 6 , 9, 1, &sipro[0][0], &:re 5 tj[ 0 ][ 0 ], &:/j)ro[0][0]); 

> 0kkx3 > 0)kk{yi > Okkyz > 0)kk{zi > Okkzs > 0)) 

{ 

= /P'o[3][0]; = /pro[4][0]; = /l)ro[5][0]; 

else 

{ 

4 .^* == -/pro[3][0]; = -/pro[4][0]; 

} 



Appendix (D) 

About Representation Scheme used (OpenGL) 

In this work, OpenGL (Open Graphics Library) is used for rendering difierent components ; 
of an assembly. The algorithm for assembly procedure has been written in “C” language 
which has good interface with OpenGL. The representation scheme being used is Boundary 

representation (B-rep) as the mating conditions are related to the faces, edges and vertices of 
the assembled parts. 

Why OpenGL ? 

Every conforming OpenGL implementation includes the full complement of OpenGL i 

functions. The weil-specihed OpenGL standard has language bindings for FORTRAN, 

Ada, and Java. Applications utilizing OpenGL functions are easily portable across a wide array 
of platforms for maximized programmer productivity and shorter time-to-maxket. | 

Besides this, using OpenGL has the following advantages: I 

• Most Widely Adopted Graphics Standard 

OpenGL is the premier, environment for developing portable, interactive 2D and S 
3D graphics applications. Since its introduction in 1992, OpenGL has become the in- 
dustry’s most widely used and supported 2D and 3D graphics application progra mming 
interface (API), bringing thousands of applications to a wide variety of computer plat- 
forms. OpenGL fosters innovation and speeds application development by incorporating 
a broad set of rendering, texture mapping, special effects, and other powerful visualiza- 
tion functions. ; 

• High Visual Quality stud Performance 

Any visual computing application requiring maximum performance-from 3D ani- 
mation to CAD to visual simulation can exploit high-quality, hi^-performance OpenGL 

capabilities. These capabilities allow developers in diverse markets such as broadcasting, 

CAD/CAM/CAE, entertainment, medical imaging, and virtual reality to produce and 
display incredibly compelling 2D and 3D graphics. I 




The book is to be returned on 
the date last stamped. 



